NAVAL  POSTGRADUATE  SCHOOL 

Monterey,  California 


L-llol 

THE 

DESIGN  AND  IMPLEMENTATION 

OF  A 

POSITION  MEASURING  SYSTEM  FOR 

A  REMOTELY  CONTROLLED  VIDEO  CAMERA 

by 

Peter  D.  Lloyd 

June  1989 

Th< 

=sis  Advisor:             Alfred  W. 

Cooper 

Co- 

-Advisor : 

Hal  A 

.  Titus 

Approved  for  public  release;  distribution  is  unlimited 


T245986 


nclassified 

:unty  classification  of  this  page 


REPORT   DOCUMENTATION   PAGE 


a  Report  Security  Classification  Unclassified 


lb  Restrictive  Markings 


a  Security  Classification  Authority 


b  Declassification  Downgrading  Schedule 


3  Distribution  Availability  of  Report 

Approved  for  public  release;  distribution  is  unlimited. 


Performing  Organization  Report  Number(s) 


5  Monitoring  Organization  Report  Number(s) 


a  Name  of  Performing  Organization 

■•'aval  Postgraduate  School 


6b  Office  Symbol 
(if  applicable)  62 


7a  Name  of  Monitoring  Organization 

Naval  Postgraduate  School 


:  Address  (dry,  state,  and  ZIP  code) 

lonterey,  CA  93943-5000 


7b  Address  (city,  state,  and  ZIP  code) 
Monterey,  CA  93943-5000 


a  Name  of  Funding  Sponsoring  Organization 


8b  Office  Symbol 
(if  applicable) 


9  Procurement  Instrument  Identification  Number 


Address  (city,  state,  and  ZIP  code) 


10  Source  of  Funding  Numbers 


Program  Element  No    Project  No     Task  No     Work  Unit  Accession  No 


i  Title  (include  secuntv  classification)  THE  DESIGN  AND  IMPLEMENTATION  OF  A  POSITION  MEASURING  SYSTEM 
OR  A  REMOTELY  CONTROLLED  VIDEO  CAMERA 


l  Personal  Author^  Peter  D.  Llovd 


3a  Type  of  Report 
taster's  Thesis 


13b  Time  Covered 
From  To 


14  Date  of  Report  (year,  month,  day) 
June  1989 


15  Page  Count 
133 


5  Supplementary  Notation  The  views  expressed  in  this  thesis  are  those  of  the  author  and  do  not  reflect  the  official  policy  or  po- 
tion  of  the  Department  of  Defense  or  the  U.S.  Government.  


7  Cosati  Codes 


ield 


Group 


Subgroup 


IS  Subject  Terms  (continue  on  reverse  if  necessary  and  identify  by  block  number) 

Position  measurement,  microprocessor,  MC68705U3,  M68705EVM,  optical  shaft  encoder. 
HEDS-6000.IRSTD. 


)  Abstract  (continue  on  reverse  if  necessary  and  identify  by  block  number) 

A  position  measuring  system  for  a  remotely  controlled  video  camera  was  designed  and  built.  The  camera  is  intended  to 
e  used  with  the  modified  Advance  Development  Model  of  the  ANSAR-8  Infrared  Search  and  Target  Designation  System 
iRSTD)  in  use  at  the  Naval  Postgraduate  School.  The  video  data  collected  by  the  camera  will  be  correlated  with  the  infrared 
ata  from  the  IRSTD  to  develop  a  background  data  base  that  will  be  used  in  the  developement  of  signal  processing  algo- 
thms. 

The  measurement  system  uses  two  Hewlett  Packard  HEDS-6000  incremental  optical  encoders,  two  Motorola 
1C68705U3  microprocessors  and  two  digital  display  devices  to  measure  and  present  the  camera's  azimuth  and  elevation 
ngles  to  an  operator  at  a  remote  location.  The  azimuth  can  be  measured  over  a  range  of  360°  with  a  resolution  of 
:  0.0213°  and  the  elevation  can  be  measured  over  24°  with  a  resolution  of  ±  0.1383.  The  resolution  is  limited  primarily  by 
ysteresis,  which  is  due  to  the  backlash  in  the  gears  between  the  transducers  and  the  axes  of  interest. 


'  Distribution  Availability  of  Abstract 

3  unclassified  unlimited  D  same  as  report 


□  DTIC  users 


21  Abstract  Security  Classification 
Unclassified 


la  Name  of  Responsible  Individual 
.Ifred  W,  Cooper 


22b  Telephone  (include  Area  code) 
(408)  646-2452 


22c  Office  Svmbol 
61Cr 


3  FORM  1473,84  MAR 


S3  APR  edition  may  be  used  until  exhausted 
All  other  editions  are  obsolete 


security  classification  of  this  page 
Unclassified 


Approved  for  public  release;  distribution  is  unlimited. 

The  Design  and  Implementation 

of  a  Position  Measuring  System 

for  a  Remotely  Controlled 

Video  Camera 

by 

Peter  D.  Lloyd 

Captain,  United  States  Marine  Corps 

B.S.,  United  States  Naval  Academy,  1979 

Submitted  in  partial  fulfillment  of  the 
requirements  for  the  degree  of 

MASTER  OF  SCIENCE  IN  ELECTRICAL  ENGINEERING 

from  the 

NAVAL  POSTGRADUATE  SCHOOL 

June  1989 


ABSTRACT 

A  position  measuring  system  for  a  remotely  controlled  video  camera  was  designed 
and  built.  The  camera  is  intended  to  be  used  with  the  modified  Advance  Development 
Model  of  the  AN/SAR-8  Infrared  Search  and  Target  Designation  System  (IRSTD)  in 
use  at  the  Naval  Postgraduate  School.  The  video  data  collected  by  the  camera  will  be 
correlated  with  the  infrared  data  from  the  IRSTD  to  develop  a  background  data  base 
that  will  be  used  in  the  developement  of  signal  processing  algorithms. 

The  measurement  system  uses  two  Hewlett  Packard  HEDS-6000  incremental  optical 
encoders,  two  Motorola  MC68705U3  microprocessors  and  two  digital  display  devices  to 
measure  and  present  the  camera's  azimuth  and  elevation  angles  to  an  operator  at  a  re- 
mote location.  The  azimuth  can  be  measured  over  a  range  of  360°  with  a  resolution  of 
±0.0213°  and  the  elevation  can  be  measured  over  24°  with  a  resolution  of  ±0.138°. 
The  resolution  is  limited  primarily  by  hysteresis,  which  is  due  to  the  backlash  in  the  gears 
between  the  transducers  and  the  axes  of  interest. 
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THESIS  DISCLAIMER 

The  reader  is  cautioned  that  computer  programs  developed  in  this  research  may  not 
have  been  exercised  for  all  cases  of  interest.  While  every  effort  has  been  made,  within 
the  time  available,  to  ensure  that  the  programs  are  free  of  computational  and  logic  er- 
rors, they  cannot  be  considered  validated.  Any  application  of  these  programs  without 
additional  verification  is  at  the  risk  of  the  user. 
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I.     INTRODUCTION 

A.     BACKGROUND 

The  old  saying  that  "every*  solution  breeds  new  problems",  while  somewhat  pessi- 
mistic, quite  often  rings  true  in  today's  increasingly  technical  world.  One  such  example 
is  the  use  of  infrared  (IR)  sensors  for  the  detection,  tracking  and/or  identification  of 
targets  in  a  combat  environment.  IR  sensors  are  ideally  suited  for  use  on  today's  bat- 
tlefield. They  are  passive,  i.e.,  they  do  not  need  to  emit  energy  in  order  to  detect  the 
presence  of  potential  targets.  This  allows  them  to  operate  during  times  of  emission 
control  when  many  other  target  detection  systems  are  useless.  They  have  the  ability  to 
"see  through"  many  forms  of  camouflage  and  concealment,  dust,  clouds,  smoke,  etc., 
that  might  otherwise  afford  an  enemy  target  a  safe  haven.  Additionally,  because  almost 
everything  on  today's  battlefield  generates  some  degree  of  infrared  energy,  IR  sensors 
can  be  used  to  locate  and  identify  a  wide  variety  of  targets. 

The  extent  to  which  a  particular  IR  sensor  is  useful  depends  primarily  on  its  ability 
to  detect  and  identify  targets  reliably  and  accurately.  Detection  of  the  target  is  primarily 
a  function  of  the  IR  sensor's  sensitivity.  The  classification  of  a  received  IR  signal  as  a 
potential  target  or  as  background  noise,  while  still  dependant  on  the  sensitivity  of  the 
sensors,  is  primarily  a  function  of  the  quality  of  the  signal  processing  algorithms  being 
used  to  process  the  received  signals.  In  addition  to  being  reliable  these  algorithms  must 
be  able  to  process  the  received  signals  in  "real  time"  if  the  system  is  to  be  an  effective 
weapons  system. 

Creation  of  a  background  data  base  that  can  be  used  to  test  some  of  these  algo- 
rithms has  been  one  of  the  tasks  being  performed  by  the  Naval  Academic  Center  for 
Infrared  Technology  (NACIT)  located  at  the  Naval  Postgraduate  School  (NTS).  The 
Advanced  Development  Model  (ADM)  of  the  AN/SAR-8  was  sent  to  the  NACIT  in 
January  of  1984  from  the  Naval  Surface  Weapons  Center  (NSWC)  at  Dahlgren, 
Virginia.  The  ADM  was  modified,  calibrated  and  placed  in  service  at  NPS  in  December, 
1987.  The  modified  version  of  the  ADM,  the  Infrared  Search  and  Target  Designation 
(IRSTD)  System,  is  currently  operational  at  NPS.   [Ref.  1:  pp.  8-12] 

One  way  to  enhance  the  usefulness  of  the  IR  data  being  collected  at  NPS  would  be 
to  collect  video  data  concurrently  with  the  IR  data.  A  video  image  of  a  portion  of  the 
horizon  would  permit  visual  identification  of  IR  sources  in  that  region.   This  additional 


tional  information  could  be  an  aid  in  the  development  of  the  signal  processing  algo- 
rithms for  the  1RSTD.  Accordingly,  a  decision  to  proceed  with  video  data  collection 
was  made  by  NACIT,  and  a  camera  system  was  purchased.  Components  of  the  system 
include; 

•  RCA  (TC1005  01),  Closed  circuit  video  camera. 

•  PELCO  (AI700),  Automatic  iris  servo. 

•  PELCO  (F1.5X),  1.5  times  range  extender. 

•  PELCO  (MLZ6DT),  Desk  top  lens  remote  control  module. 

•  PELCO  (PT1250DC),  Heavy  duty  Pan/Tilt  servo. 

•  PELCO  (MPTV1510DT),  Pan/Tilt  remote  control  unit. 

•  Panasonic  (WV-5410),  Video  Monitor. 

In  Ref.  1  Avers  describes  the  IRSTD's  detectors: 

The  IR  detectors  consist  of  two  vertical  arrays  of  sensing  elements  in  the  focal  plane 
of  the  Schmidt  telescope.  The  telescope  is  rotated  so  as  to  sweep  the  image  across 
the  detector  arrays.  Each  array  incorporates  a  column  of  90  indium  antimonide 
photovoltic  linear  detector  elements.  These  two  arrays  are  independent  of  each 
other  and  are  covered  by  filters  which  pass  selected  wavebands  of  IR  radiation  in  the 
3  to  5  micrometer  range.  Each  element  has  the  angular  dimensions  of  2  X  .3 
milliradians  with  the  larger  being  its  height.  Designated  as  the  lead  and  the  lag. 
these  two  arrays  are  separated  by  about  one-half  degree  in  azimuth.   [Ref.  1:  p.  17] 

Thus,  as  the  IRSTD  scans  the  horizon  the  resulting  IR  image  has  a  resolution  of  ap- 
proximately 10-4  radians  (0.00573°)  in  the  horizontal  plane  and  0.23°  in  the  vertical 
plane.  The  video  system's  smaller  field  of  view  can  be  remotely  controlled  using  the 
control  units  listed  above.  Thus,  for  the  video  data  to  be  of  any  use  in  the  development 
of  the  signal  processing  algorithms,  the  camera's  orientation  must  first  be  known,  and, 
in  order  to  determine  the  pixel-to-pixel  correlation  between  the  IR  image  and  the  video 
image,  the  position  of  the  video  camera  needs  to  be  known  with  the  same  kind  of  accu- 
racy as  the  IR  image.  The  design  and  implementation  of  a  position  measuring  system 
for  this  remotely  controlled  video  camera  is  the  subject  of  this  thesis. 

B.     DESIGN  SPECIFICATIONS 

The  design  specifications  for  this  problem  were  relatively  straight  forward.   The  po- 
sition measuring  system  needed  to  meet  the  following  criteria. 

•  The  system  should  be  able  to  measure  the  elevation  angle  (tilt),  above  and  below 
the  horizontal  reference  plane  of  the  camera  over  a  range  of  ±  12°. 

•  The  measured  elevation  ancle  should  be  accurate  to  within  ±  0.23°  . 


The  system  should  be  able  to  measure  the  bearing  (pan),  left  or  right  of  some  ar- 
bitrary reference,  of  the  camera  over  a  range  of  360°. 

The  measured  bearing  should  be  accurate  to  within  ±  10~4  radians. 

The  output  should  be  displayed  in  a  convenient  form.  The  display  should  be 
collocated  with  the  camera  servo  remote  controls,  an  indoor  site  approximately  200 
meters  away  from  the  camera. 

Portions  of  the  measuring  system  required  to  be  collocated  with  the  camera  should 
be  weatherproofed. 

The  system  must  be  reliable  and  should  be  simple  to  operate. 


II.     DESIGN  STRATEGY 

A.     GENERAL 

A  position  measuring  system,  like  any  system,  is  a  combination  of  devices  intercon- 
nected to  perform  a  certain  function.  The  most  basic  position  measuring  system  (see 
Figure  1)  consists  of  only  four  such  devices:  a  transducer,  a  signal  conditioner,  a  display 
device  and  a  power  supply.  More  complicated  position  measuring  systems  include  those 
designed  to  take  a  number  of  different  measurements  either  simultaneously  or  consec- 
utively. Still  more  complex  systems  multiplex  these  various  measurements  over  a  single 
channel  to  some  distant  location  where  they  can  be  processed  and  displayed.  [Ref.  2: 
pp.  2-14] 

The  design  specifications  for  the  camera  position  measurement  system  (subsequently 
referred  to  as  the  "measurement  system")  required  that  two  measurements,  pan  and  tilt, 
be  taken  simultaneously  and  transmitted  some  distance  to  a  remote  display.  Two  sepa- 
rate transducers,  capable  of  independent  operation,  were  therefore  required.  In  order  for 
both  the  azimuth  and  the  elevation  to  be  displayed  simultaneously  two  display  devices 
were  also  required. 

Several  pairs  of  RG-178  coaxial  cable  were  available  to  transmit  signals  between  the 
camera  servo  and  the  remote  control  site.  Since  the  cable  was  available  and  it  was  de- 
sirable to  reduce  the  system  complexity,  a  decision  was  made  not  to  multiplex  the  data 
over  a  single  channel.  Instead,  each  measurand  would  have  a  separate  transducer,  a 
dedicated  signal  processor  and  a  unique  display  device.  Position  information  for  each 
axis  would  be  transmitted  over  a  dedicated  channel. 

The  physical  locations  of  the  transducers  and  the  display  devices  were  dictated  by 
the  design  specifications;  however,  there  was  some  flexibility  in  deciding  where  to  locate 
the  signal  conditioner.  Site  selection  was  based  on  an  attempt  to  maximize  total  system 
performance  and  simplicity  while  ensuring  the  maintainability  and  environmental  integ- 
rity of  the  signal  conditioner.  The  only  advantage  to  locating  the  signal  conditioner  with 
the  camera  servo  and  the  transducer  would  have  been  to  limit  the  distance  that  the 
transducer's  output  signal  would  have  to  be  transmitted  to  the  processor.  On  the  other 
hand,  separating  the  signal  conditioner  and  the  transducers  would  limit  the  distance  over 
which  the  conditioned  signal  would  have  to  be  transmitted  to  the  display  device.  The 
trade-off  here  was  not  clear  cut  and  would  probably  depend  on  the  specific  hardware 
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Figure    1.       Basic  Electronic  Position  Measuring  System:     From  Rcf.  2:  p.  2 


used  and  the  speed  of  rotation  of  the  camera  servo.  There  was  one  significant  advan- 
tage, however,  to  collocating  the  display  and  the  signal  processor;  since  they  would  both 
be  indoors,  the  need  for  wcatherproofing  the  signal  processor  would  be  eliminated. 

Power  was  available  at  both  ends  of  the  system,  there  was  therefore  no  requirement 
to  have  a  common  power  supply  for  the  entire  system.  One  supply  could  be  used  to 
provide  power  to  the  two  transducers,  collocated  with  the  camera  servo,  and  a  second 
supply  could  power  the  signal  conditioner  and  the  displays. 

A  block  diagram  of  the  prototype  measurement  system  is  shown  interconnected  with 
the  camera  positioning  system  in  Figure  2.  Once  this  basic  system  layout  had  been  de- 
termined, proper  selection  of  the  actual  hardware  was  necessary.  The  design  criteria 
were  the  primary  consideration  in  the  initial  stages  of  the  hardware  selection.  Final  se- 
lection of  the  specific  components,  however,  involved  balancing  additional  factors,  such 
as  availability  and  cost  against  the  system  requirements. 
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Figure  2.      Camera  Position  Measuring  System 


B.     TRANSDUCERS 
1.     General 

Since  in  practice  most  measurement  systems  do  not  have  the  ability  to  respond 
directly  to  the  measurand,  transducers  are  used  to  convert  one  physical  quantity  (e.g., 
angular  position)  into  another,  more  usable  quantity  or  signal  (e.g.,  an  electrical  signal) 
[Ref.  3:  p.  1-4].  The  transducer  is  therefore  a  vital  part  of  any  measurement  system,  and 
although  none  of  the  components  of  this  system  could  have  been  chosen  independently 
of  the  other  elements,  proper  transducer  selection  appeared  to  be  the  key  to  meeting  the 
design  specifications.  Thus,  selection  of  a  transducer  was  the  next  step  in  the  design 
process. 

Using  the  selection  guidelines  given  by  Norton  on  pages  51-53  of  Ref.  2  and  the 
design  criteria  stated  previously,  several  observations  and  decisions  were  made  which 
significantly  reduced  the  number  of  transducers  considered  feasible  for  use  in  the  meas- 
urement system.  The  fact  that  the  servo  was  capable  of  rotating  the  camera  left  or  right, 
and  up  or  down  suggested  that  the  transducer  should  be  capable  of  detecting  both  in- 
creasing and  decreasing  angles  on  both  axes.  Additionally,  since  the  servo  was  antic- 
ipated to  rotate  the  camera  through  one  360°  arc  in  the  horizontal  plane,  the  transducer 
used  to  measure  this  angle  (subsequently  referred  to  as  the  "pan  transducer")  needed  to 
have  a  comparable  range  capability.  The  range  requirement  for  the  "tilt  transducer" 
(used  to  measure  the  elevation  angle)  was  much  less  restrictive.  These  factors,  angular 
bidirectional  capability  and  full  scale  range,  eliminated  a  great  number  of  transducers 
from  the  list  of  candidates. 

The  list  was  further  narrowed  by  the  accuracy  requirements  previously  specified. 
Again  the  accuracy  in  the  horizontal  plane  placed  a  much  more  severe  limitation  on  the 
selection  of  a  transducer  than  the  accuracy  requirements  for  the  vertical  plane.  The 
following  paragraphs  in  this  section  outline  the  logic  used  in  the  selection  of  the 
transducers.   The  factors  considered  in  the  selection  process  included  the  following; 

•  The  accuracy  requirements  given  in  the  specifications. 

•  The  ease  with  which  a  specific  transducer  could  be  installed  on  the  servo. 

•  The  ability  to  weatherproof  the  servo  and  the  transducer  once  the  transducer  was 
installed. 

•  The  rotation  speed  of  the  camera  about  the  servo  axes. 

•  The  extent  to  which  a  particular  transducer/mounting  configuration  would  modify 
the  measurand. 

•  Cost  effectiveness. 


•  Availability. 

•  Signal  conditioning  requirements. 

•  The  extent  to  which  the  selection  of  a  particular  transducer  would  simplify  or 
complicate  the  modification  or  expansion  of  the  measurement  system. 

2.     Transducer  technologies 

Displacement  transducer  technologies  fall  into  three  very  broad  categories  de- 
pending on  whether  they  are  capable  of  measuring  linear  or  angular  displacement,  or 
both.  Some  technologies  could  be  eliminated  immediately  since  they  were  clearly  not 
suited  for  measuring  angular  position.  Strain  gauge  displacement  transducers,  inductive 
displacement  transducers  and  vibrating-wire  displacement  transducers  are  examples  of 
such  devices.  The  following  paragraphs  briefly  describe  the  different  transducer  tech- 
nologies which  were  investigated.  Table  1  on  page  18  summarizes  the  salient  points  of 
the  discussion.   [Ref.  2:  pp.  90-117]. 

a.     Reluctive  Displacement  Transducers 

The  rotary  variable  differential  transformer  (RVDT),  which  operates  by 
detecting  a  change  in  the  reluctance  between  coils,  offers  excellent  resolution,  dynamic 
characteristics,  linearity  and  life  expectancy  [Ref.3:  p.  (2-14)].  Figure  3  shows  a  sche- 
matic diagram  and  a  simplified  cross-section  of  an  RVDT.  The  ferromagnetic, 
cardioid-shaped  core  is  attached  to  a  shaft  as  shown.  As  the  shaft  rotates,  the  inductive 
coupling  between  the  primary  and  each  of  the  secondary  coils  changes.  When  the  cam 
is  symmetric  with  respect  to  the  two  secondary  coils,  their  output  voltages  are  equal  but 
opposite  in  phase  which  results  in  a  differential  output  voltage  of  zero.  As  the  shaft 
rotates  away  from  this  "null"  the  differential  output  voltage  varies  as  shown  in 
Figure  4.  The  linear  region  of  the  curve  is  limited  to  the  angles  between  ±  40°  of  the 
reference.  Thus,  the  RVDT  could  not  be  used  on  the  Pan  axis.  It  was  however,  initially 
considered  as  a  candidate  for  the  Tilt  transducer.  [Refs.  2:  pp.  93-99,  3: 
pp.  (9-10)-(9-13)  and  4:  p.   19] 

Another  type  of  reluctive  displacement  transducer  is  manufactured  by 
Farrand  Controls.  Their  INDLCTOSYN  rotary  position  transducers  have  accuracies 
to  ±  1.5  arc  sec  (^(4  x  10-4)°).  Unfortunately,  these  devices  are  1 1.89  inches  in  diameter, 
and  mounting  them  on  the  camera  servo  would  have  been  extremely  difficult,  if  not  im- 
possible. [Refs.  2:  pp.  89-111,  5] 
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Figure  3.      RVDT  Schematic:     From  Rcf.  2:  p.  98. 


b.     Capacitive  Displacement  Transducers 

Angular  displacement  can  also  be  measured  by  coupling  the  rotating  com- 
ponent to  the  shaft  a  of  variable  capacitor  in  the  manner  shown  in  Figure  5.  Lenk  de- 
scribes the  operation  of  the  capacitive  displacement  transducer  quite  succinctly. 

The  capacitor  ...  consists  of  a  metal  plate  that  moves  between  two  fixed  metal  plates 
as  a  shaft  is  rotated.  The  three  plates,  and  the  air  between  them,  form  a  capacitor 
with  a  capacitance  that  varies  in  proportion  to  the  degree  to  which  the  plates  are 
meshed.  When  the  plates  are  completely  meshed,  the  capacitance  is  at  its  maximum. 
When  the  plates  are  completelv  unmeshed,  the  capacitance  is  at  minimum.  [Ref.  4: 
p.  IS] 

Capacitive  displacement  transducers  ofTer  many  of  the  advantages  of  reluc- 
tance displacement  transducers.  They  have  an  efTective  range  of  about  300°  which,  while 
better  than  the  RVDT's  range,  is  still  not  adequate  for  the  pan  axis  [Ref.  4:  p.  18].  Ad- 
ditionally they  are  more  sensitive  to  changes  in  the  ambient  temperature.     Since  the 
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Figure  4.      RVDT  Output  Characteristics:     From  Ref.  2:  p.  95. 
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Figure  5.      Capacitive  Displacement  Transducer:     Ref.  4:  p.  IS. 

measurement  system  was  being  designed  to  be  used  outdoors,  the  use  of  a  capacitive 
displacement  transducer  would  have  required  the  addition  of  a  temperature  compensator 
in  the  design.  While  possible,  this  would  have  increased  the  system  complexity  consid- 
erably.   [Ref.  2:  pp.  90-9 Ij 
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c.     Potentiometric  Displacement  Transducers 

Another  very  common  and  relatively  simple  family  of  transducers  operate 
by  measuring  the  change  in  resistance  caused  by  a  change  in  the  measurand.  There  are 
a  wide  variety  of  such  devices  available.  The  basic  form  of  potentiometric  angular  dis- 
placement transducers  uses  a  resistance  element,  formed  into  an  arc,  and  a  movable 
electrical  contact  that  rotates  about  the  axis  of  interest.  By  measuring  the  change  in 
resistance  that  results  from  a  change  in  position,  one  is  able  to  determine  the  angular 
displacement.  The  resistive  element  is  typically  a  wirewound  element,  the  resolution  of 
which  is  determined  by  the  number  of  turns  per  unit  length  of  the  resistance  element. 
The  angular  resolution  can  be  increased  by  increasing  the  turn  density  (wires/degree)  of 
the  potentiometer. 

The  practical  limit  for  wire  spacing  on  wirewound  elements  according  to 
Ref.  6  is  between  500  and  1000  turns  per  inch.  From  Figure  6  one  can  see  that  this 
limits  the  angular  resolution  for  a  single-turn  device  to 

/  Ax  (in)  \ 

A9(rad)^_L_j  (1) 

Therefore, 

2AX       0.002(in) 

To  achieve  the  10-4  rad  resolution,  specified  for  the  Pan  axis,  with  a  single  turn 
potentiometer  would  therefore  require  a  20  in  diameter  potentiometer.  Mounting  a  de- 
vice this  large  on  the  camera  servo  was  simply  not  feasible.  Potentiometers  are,  how- 
ever, available  with  multiple  turns.  Shaped  in  a  helix  fashion  similar  to  that  shown  in 
Figure  7.  the  total  length  of  the  potentiometer  can  be  increased,  which  in  turn  increases 
its  resolution,  without  increasing  the  diameter  of  the  device. 

Increasing  the  resolution  of  the  potentiometer  by  increasing  the  turn  density 
in  any  of  the  manners  described  above,  however,  increases  the  output  impedance  of  the 
device,  which  leads  to  increasing  nonlinearity  between  the  measurand  and  the  transducer 
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Figure  6.      Geometry  of  an  Angular  Potentiometric  Transducer 
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Figure  7.      Multiturn  Potentiometer:     From  Ref.  6:  p.  218 

output.     The  nonlinear  relationship  can  be  seen  by  analyzing  the  circuit  shown  in 
Figure  8.    In  the  diagram  the  following  variable  definitions  apply: 

•  ex  =  Input  voltage, 

•  e0  =  Output  voltage, 

•  KF  =  Total  resistance  of  the  potentiometer, 

•  Rm  =  Meter  resistance, 

•  x,  =  Total  range  of  the  potentiometer,  and 

•  x,  =  Actual  displacement  of  the  potentiometer. 

Assuming  that  R,is  uniformly  distributed  over  x„  analysis  of  the  voltage  divider  circuit 
gives, 


X; 


1 


f(*M) 


(3) 
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Figure  8.      Potentiometric  Transducer:     From  Ref.  6:  p.  219 


Thus,  the  ideal  (i.e..  linear  )  relationship, 


x 


(4) 


is  true  only  when  R,  R„  =  0,  and  since  Rp  ^  0,  and  Rm  ^  oo,  the  nonlinear  relationship  in 
(3)  will  always  exist.  Doebelin  states  that  "for  values  of  R,/R„,  <  0.1  the  position  of 
maximum  error  occurs  in  the  neighborhood  of  xjx,  =  0.67,  and  the  maximum  error  is 
approximately  15(RP/Rm)  percent  of  full  scale."  [Ref.  6:  p.  218]  Other  potentiometric 
transducers,  which  use  a  resistive  element  made  of  carbon  film  or  a  conducting  plastic, 
are  not  subject  to  the  same  kind  of  resolution  limitations  as  wirewound  devices;  however, 
they  do  have  high  output  impedances  and  the  corresponding  nonlinearities  described 
above.   [Ref.  6:  pp.  217-224] 

A  high  quality  multiturn  potentiometer  used  in  conjunction  with  a  high 
quality  voltmeter  offered  one  possible  solution  to  the  design  problem.  However,  the 
nonlinearity  of  this  arrangement  was  a  significant  disadvantage,  and  the  primary  reason 
why  potentiometers  were  not  used. 
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d.     Encoders 

The  angular  displacement  transducer,  referred  to  in  general  as  an  angular 
encoder  or  shaft  encoder,  converts  an  angular  displacement  into  a  digital  signal  without 
the  use  of  an  analog-to-digital  converter.  In  today's  increasingly  digital  world  this  can 
be  a  distinct  advantage. 

There  are  three  different  transduction  methods  used  in  encoders.  Magnetic 
encoders  use  a  pattern  made  from  magnetized  and  nonmagnetized  segments  and  one  or 
more  magnetic  sensors  that  register  as  either  "l's"  or  "O's"  depending  on  the  magnetic 
characteristics  of  the  section  that  they  are  adjacent  to.  Brush-type  encoders  are  similar, 
but  the  sections  are  made  of  conducting  and  nonconducting  materials.  The  conductors 
are  all  tied  to  a  common  source  and  the  "sensor"  is  one  or  more  brushes  connected  to 
the  output.  When  the  brush  is  in  contact  with  one  of  the  conductors  the  output  is 
"on''  and  when  the  brush  is  in  contact  with  an  insulator  the  output  is  "off".  Optical 
encoders  (See  Figure  9)  use  a  pattern  of  opaque  sections  marked  on  an  otherwise 
transparent  disk.  A  light  emitting  diode  (LED),  or  other  light  source,  is  placed  on  one 
side  of  the  disk,  and  as  the  disk  rotates  a  light  sensor  on  the  other  side  of  the  disk 
"sees"  periods  of  dark  and  light  which  it  converts  into  a  digital  signal.   [Ref.  2:  p.  106] 

Angular  encoders  are  further  categorized  as  either  absolute  encoders  or  in- 
cremental encoders.  Absolute  encoders,  similar  to  the  optical  encoder  shown  in 
Figure  9,  use  a  multitrack  pattern  on  a  code  wheel  to  produce  a  unique  coded  output 
signal  for  each  incremental  change  in  the  measurand.  These  wheels  use  a  variety  of 
codes,  including  binary  code,  binary-coded  decimal  (BCD)  and  Gray  code,  to  determine 
the  shaft  position.  The  resolution  of  an  absolute  shaft  encoder  is  limited  by  the  number 
of  tracks  on  the  disk  and  the  type  of  code  used.  A  simple  binary  or  Gray  code  encoder, 
which  are  more  efficient  than  the  BCD  encoders,  with  N  tracks  has  an  optimum  angular 
resolution  of 

Ad  =  ^-    .  (5) 

2 

Thus,  to  achieve  the  desired  resolution  of  10~4  radians  on  the  Pan  axis  with  an  absolute 
encoder  would  require  a  code  wheel  with  N  >  16.  Since  the  output  from  the  encoder  is 
unique  for  each  position,  these  devices  are  not  affected  by  power  outages,  and  the  re- 
quirements for  a  signal  processor  for  such  a  device  would  be  limited  to  a  simple  decoding 
circuit.   These  encoders  can  measure  angles  of  up  to  360°  without  ambiguity. 
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Incremental  encoders  use  a  code  wheel  which  has  only  one  track.  As  the 
shaft  of  the  incremental  encoder  rotates  the  output  from  the  encoder  is  a  series  of 
equally  spaced  pulses.  These  pulses  can  then  be  used  as  an  input  signal  to  an  up  down 
(UD)  counter  of  some  sort.  The  output  from  the  counter  is  an  indication  of  the  dis- 
placement of  the  axis  from  some  predetermined  reference.  The  resolution  of  an  incre- 
mental encoder  is  a  function  of  the  number  of  pulses  the  code  wheel  generates  per 
revolution  and  is  given  by; 


Ad  = 


360c 


nx  PPR 


(6) 


where  PPR  is  the  number  of  pulses  per  revolution  of  the  code  wheel,  and  n  is  the  number 
of  revolutions  that  the  code  wheel  makes  per  revolution  of  the  axis  of  interest.  If  the 
incremental  shaft  encoder  was  mounted  on  the  shaft  of  interest  (n=  1)  at  least  62,832 
PPR  would  be  required  to  ensure  a  resolution  of  W)-4  radians. 
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Figure  9.       Absolute  Photoelectric  Angular  Encoder:     (a)  typical  code  disk;  (b)  en- 
coder elements.    From  Ref.  2:  p.  107. 

Shaft  encoders  currently  range  in  price  from  less  than  S  100.00  to  several 
thousand  dollars  depending  on  their  capabilities  and  the  method  of  transduction  used. 
Litton  Encoder's  Model  60  absolute  shaft  encoder  uses  a  natural  binary  code,  has  15 
tracks  (0.1917  miad  resolution)  and  is  available  "off  the  shelf  for  approximately  S3000. 
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Other  absolute  encoders  with  comparable  resolutions  are  available  at  similar  prices.  No 
incremental  encoders  were  found  which  offered  the  same  kind  of  resolution  as  Litton's 
Model  60;  however,  because  they  are  not  limited  to  one  revolution  of  the  axis,  the  re- 
solution of  an  incremental  encoder  can  be  improved  by  a  factor  of  n  by  causing  its  code 
wheel  to  rotate  n  times  for  every  rotation  of  the  axis  of  interest.  Incremental  encoders 
with  1024  PPR  are  available  from  a  variety  of  manufacturers  for  about  S100  each. 
Connecting  such  a  device  to  the  axis  of  interest  via  a  gear  train  with  a  50:1  ratio  would 
theoretically  result  (from  (6))  in  a  resolution  of  0.1227  mrad.  Incremental  encoders  do 
require  more  complex  signal  processing  than  absolute  encoders,  and  they  are  affected 
by  power  shut-off.  Additionally,  unlike  absolute  encoders,  any  missed  or  erroneous 
count  that  occurs  with  an  incremental  encoder  will  cause  a  persistent  error.  [Ref.  7: 
p.   16] 

After  considering  the  measurement  system  performance  criteria  and  the  ca- 
pabilities and  limitations  of  the  various  transducers,  the  use  of  an  incremental,  optical 
shaft  encoder  appeared  to  be  the  best  selection  for  the  transducer  for  each  axis.  This 
decision  involved  balancing  the  various  advantages  and  disadvantages  of  the  different 
transducers.  The  following  list  gives  a  summary  of  the  key  considerations  in  this  deci- 
sion. 

•  Small,  lightweight,  highly  accurate  and  relatively  inexpensive  models  were  readily 
available.  Being  small  and  lightweight  suggested  that  mounting  and 
weatherproofing  the  transducers  in  the  camera  servo  should  not  be  too  difficult. 

•  Absolute  encoders  offer  almost  all  of  the  advantages  of  the  incremental  encoders; 
they  are  not  affected  by  power  outage,  they  require  less  complex  signal  processing 
and  one  time  counting  errors  do  not  persist.  However,  these  features  did  not  seem 
to  justify  the  additional  price  of  an  absolute  encoder. 

•  Linearity  and  loading  problems  associated  with  the  potentiometric  displacement 
transducers  were  avoided. 

•  Direct  conversion  of  the  measurand  into  a  digital  signal  precluded  the  requirement 
for  an  AD  converter.  (This  would  have  been  a  disadvantage  had  the  use  of  an 
analog  signal  conditioner  been  anticipated.) 

•  Using  two  identical  transducers,  each  capable  of  meeting  the  specifications  for  the 
pan  axis,  would  reduce  system  complexity  while  still  ensuring  that  the  design  spec- 
ifications were  met. 


C.     MOUNTING  THE  TRANSDUCER 

Once  the  decision  to  use  an  incremental  optical  shaft  encoder  was  made,  selection 
of  a  specific  model  remained.    Before  selection  of  an  actual  piece  of  hardware  could  be 
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Table  1.     ANGULAR  DISPLACEMENT  TRANSDUCERS 


TRANSDUCER 

DESIGN 

RANGE 

RESOL- 
UTION 

LINEAR- 
ITY 

OTHER 

Reluctive 

Displacement 

(RVDT) 

0°  -360° 

Theore- 
tically infi- 
nite; ' 

Limited  by 
the  signal' 
condi~ 
tioner. 

Poor  bevond 
±40°     ' 

Reluctive 
Displacement 
(Farrand's 
INDUCTOSYN) 

0°  -360° 

±  (4  x  10^)° 

Good 

Large  size  limits  use- 
fulness with  the  cam- 
era measuring 
svstem. 

Capacitive 
Displacement 

0°  -300° 

Theore- 
tically infi- 
nite; 

Limited  by 
the  signal 
condi- 
tioner. 

Good 

Temperature  sensi- 
tive 

Potentiometric 
Displacement 

0°  -3500° 

Device 
dependent 

Device 

dependent 

The  trade-off  be- 
tween 

range  resolution  and 
linearity  due  to  the 
loading  effect  of  the 
noninfinite 
impedance  of  the  sig- 
nal conditioning  de" 
vices  used. 

Absolute 
Encoders 

0°  -360° 

360° 

Good 

No  A  D  conversion 
required.    Insensitive 
to  power  shut-off. 

Incremental 
Encoders 

+  oo 

360° 

Good 

Simple.    Requires 
more  signal  process- 
ing than  absolute  en- 
coder but  is  less 

expensive. 

n  x  PPR 

done  though,  one  additional  practical  consideration  had  to  be  made;  where  and  how 
could  a  transducer  be  mounted  in  or  on  the  servo  in  order  to  measure  the  position  of  the 
Pan  and  Tilt  axes? 

The  physical  layout  of  the  camera  positioning  servo  made  direct  connection  of  any 
type  of  transducer  to  the  axes  of  interest  virtually  impossible  without  major  modification 
of  the  servo  itself.  Major  modification  of  the  servo  would  have  been  expensive,  time 
consuming  and  outside  the  scope  of  this  thesis.  It  was  not  considered  an  option  in  this 
case.  Measurement  of  the  Pan  and  Tilt  axes'  displacements  was  most  readily  accom- 
plished indirectly.  Each  axis  of  the  servo  is  positioned  by  a  separate  dc  motor  via  a  gear 
train.    By  mounting  the  shaft  encoder  code  wheels  to  the  sprockets  (items  42  and  43  in 
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Figure  10)  which  are  each  attached  to  one  of  the  worms,  an  indirect  measurement  of  the 
position  of  each  of  the  wormgears  (items  5  and  7  in  Figure  10)  was  possible.  This  ap- 
proach, made  necessary  by  the  servo  design,  was  a  mixed  blessing. 

The  backlash  in  a  worm-wormgear  connection  will  cause  the  position  of  the  worm 
to  be  different  for  any  given  wormgear  position,  depending  on  whether  that  position  is 
approached  from  a  clockwise  or  a  counterclockwise  direction.  In  order  to  correctly  de- 
termine the  displacement  of  the  wormgear  by  measuring  the  displacement  of  the  worm, 
the  amount  of  backlash  present  must  be  known  (i.e.,  would  have  to  be  determined  ex- 
perimentally) and  accounted  for  by  the  measurement  system.  This  nonlinear  source  of 
error  would  not  have  been  a  concern  if  the  servo  was  only  required  to  rotate  in  one  di- 
rection. This  was  not  the  case,  however,  and  hysteresis  eventually  was  determined  to 
be  the  largest  single  source  of  error  in  the  measurement  system.  A  more  complete  dis- 
cussion of  this  topic  is  included  in  Chapter  IV  of  this  thesis. 

Assuming  for  the  moment  that  the  effects  of  the  backlash  in  the  gears  could  have 
been  completely  compensated  for,  mounting  the  shaft  encoders  on  the  worm  provided 
a  measurement  advantage  analogous  to  the  mechanical  advantage  afforded  by  the  gear 
train.  Initial  measurements  indicated  that  each  of  the  worms  turned  through  18,000° 
(50  x  360°)  for  every  360°  rotation  of  the  corresponding  wormgear.  This  meant  that  a 
shaft  encoder  with  100  divisions  per  360°  attached  to  the  worm  axis  could  do  the  same 
job  as  a  5,000  division  per  360°  encoder  attached  to  the  wormgear  axis. 

D.     SELECTING  AN  OPTICAL  SHAFT  ENCODER 

Once  the  basic  decisions  to  use  incremental  optical  shaft  encoders  and  to  mount  the 
encoders  on  the  worms  inside  the  servo  housing  had  been  made,  selection  of  the  specific 
pieces  of  hardware  was  relatively  straight  forward  and  was  primarily  a  matter  of  con- 
venience and  expediency. 

Returning  to  the  design  specifications  for  a  moment;  the  most  stringent  requirement 
was  to  be  able  to  measure  the  position  of  the  pan  axis  to  within  ±  (5.73  x  10_3)°.  To 
determine  the  required  resolution  for  the  optical  shaft  encoder,  the  following  calculations 
were  performed. 

First, 

360°/Revolution  Divisions  ,-* 

=^62,827  — ; — : .  (7) 


3o/nivicinn  "  Revolution 


5.73  x  10  '"/Division 
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Figure  10.      Camera  Servo:     From  Ref.  S:  p.  12. 
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Then,  considering  the  50:1  gear  advantage, 


62.827  gal25?    Divisions  (g) 


50  Revolution 

The  task  therefore  was  to  find  an  optical  shaft  encoder  capable  of  detecting 
bidirectional  rotation  with  at  least  1257  Divisions/ Revolution  in  a  package  small  enough 
to  mount  in  the  servo  housing  on  the  worm  axis.  There  was  no  absolute  size  limitation; 
however,  due  to  the  construction  of  the  servo  it  was  desirable  to  find  an  encoder  that 
was  no  more  than  3  in.  in  diameter  and  no  more  than  1.5  in.  in  width.  The  companies 
that  make  shaft  encoders  are  capable  of  custom  building  devices  to  meet  a  customer's 
specific  needs.  However,  the  prices  are  high,  and  the  lead  times  are  long  for  these  special 
order  parts.  The  encoder  for  this  system  needed  to  be  reasonably  priced  and  readily 
available  to  ensure  timely  completion  of  the  project  and  to  facilitate  replacement,  if 
necessary,  in  the  future. 

Optical  shaft  encoders  are  manufactured  by  numerous  companies  including  Litton, 
Honeywell,  BEI,  IVO  and  Hewlett  Packard.  Sales  literature  from  these  companies  was 
reviewed  prior  to  making  a  decision  on  the  specific  shaft  encoder  model  to  be  used.  In- 
cremental optical  shaft  encoders  with  resolutions  that  range  from  one  pulse  per  revo- 
lution (PPR)  to  2540  PPR  are  available  off  the  shelf  from  one  or  more  of  these 
companies.  While  evaluating  sources  of  supply,  incremental  optical  shaft  encoders  were 
also  found  in  use  in  various  laboratories  and  shops  in  the  Electrical  Engineering  and 
Physics  Departments  at  the  NPS.  Encoders  immediately  available  from  stock  included 
two  Vermtech  1200  PPR  (model  VOE-23-1200-AI-LD5-2L1-1603-2)  encoders  from  the 
Physics  Department  and  two  Hewlett  Packard  (HEDS-6000  J06)  encoders  from  the 
Electrical  Engineering  Department.  The  use  of  the  Vernitech  encoders  was  ruled  out 
because  they  were  unable  to  detect  bidirectional  movement  without  increasing  the  com- 
plexity of  the  signal  conditioning  subsystem.  Additionally,  technical  literature  requested 
on  two  separate  occasions  from  Vernitech  was  never  received. 

The  HEDS-6000/J06  encoders  have  a  resolution  of  1024  PPR.  Each  encoder  pro- 
vides displacement  information  in  the  form  of  TTL  logic  level  signals  via  two  output 
channels.  When  the  encoder  is  properly  adjusted  the  two  output  signals  have  a  90° 
phase  difference.  This  quadrature  phase  relationship  permits  these  encoders  to  detect 
bidirectional  displacements.     Rotation  in  one  direction  will  cause  Channel  A  to  lead 
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Channel  B  (in  phase),  while  rotation  in  the  other  direction  will  cause  Channel  B  to  lead 
Channel  A.   [Ref.  9:  p.  2] 

The  presence  of  two  output  channels  in  quadrature  phase  has  an  additional  benefit 
that  is  useful  in  some  applications.  Since  the  amount  of  position  information  has  es- 
sentially been  doubled,  if  the  signal  conditioner  is  designed  to  detect  both  the  leading  and 
trailing  edges  of  one  of  the  output  channels  the  resolution  of  the  measurement  system 
can  be  doubled.  The  difficulty  with  using  this  technique  is  that  multiple  oscillations 
about  a  single  point  cannot  be  detected  as  such.  If  the  camera  were  to  oscillate  less  than 
one  half  of  a  pulse  width  about  a  transition  the  signal  conditioner  would  detect  and  er- 
roneously count  the  multiple  transitions.   [Ref.  7:  pp.  13-16] 

With  1024  PPR,  which  is  less  than  the  1257  PPR  required  to  meet  the  0.1  milliradian 
accuracy  specification  on  the  pan  axis,  the  maximum  resolution  available,  if  the 
HEDS-6000  was  attached  to  the  worm,  can  be  calculated  as; 

=  (7.03125  x  10"3)°  Pulse"1  .  (9) 


(50  x  1024) 


Although  this  was  not  sufficient  to  satisfy  the  pan  axis  resolution  specification  of 
(5.73  x  10_3)oPulse,_1  all  of  the  other  performance  criteria  could  be  satisfied.  The  trade- 
off seemed  reasonable  and  was  approved  prior  to  proceeding  further  with  the  system 
design. 

E.  THE  DISPLAY 

Selecting  a  method  to  display  the  final  system  output  was  certainly  the  least  de- 
manding task  required  in  the  design  of  the  system.  With  an  expected  resolution  on  the 
pan  axis  of  approximately  0.007°  over  a  range  of  360°  (a  ratio  of  about  1:51,500)  an 
analog  display  seemed  out  of  the  question.  A  five  or  six  digit  digital  display  on  the  other 
hand  offered  a  simple,  reliable  and  cost  efficient  means  of  presenting  the  output.  Con- 
structing the  displays  from  individual,  seven-segment,  common  anode,  LED  devices,  and 
the  appropriate  display  drivers  was  a  straight  forward  task. 

F.  THE  SIGNAL  CONDITIONER 

Anticipating  the  use  of  two  incremental  shaft  encoders  as  the  transducers  for  the 
measurement  system  and  the  use  o[  digital  readouts  as  the  display  devices  significantly 
reduced  the  number  of  possibilities  for  the  signal  conditioning  subsystem.  In  addition 
to  the  hardware  and  software  described  in  each  of  the  subsequent  discussions,  each 
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technique  listed  here  would  require  an  edge  detector  to  detect  the  transitions  in  the  TTL 
signals  from  the  shaft  encoders. 

•  Up  down  counter  with  table  look-up. 

•  Up/down  counter  and  multiplication. 

•  Add.subtract. 

•  Microcomputer. 

•  Microprocessor. 

1.     Up/down  (U/D)  counter  with  table  look-up 

This  technique  would  involve  the  use  of  a  shift  register,  some  associated  logic, 
an  U/D  counter  and  a  table  look-up  device  such  as  an  erasable  programmable  read  only 
memory  (EPROM).  The  shift  register  would  serve  as  a  hardware  buffer  that  could  be 
used  to  account  for  the  hysteresis  introduced  by  the  worm-wormgear  assembly.  The 
length  of  the  buffer  would  have  to  be  determined  experimentally.  The  logic  associated 
with  the  shift  register  would  determine  the  "validity"  of  each  transition  (count)  signal 
from  the  edge  detector  by  checking  the  contents  of  the  shift  register  and  comparing  the 
current  direction  of  rotation  with  the  previous  direction  of  rotation.  Whenever  the  logic 
detected  a  change  in  rotation  direction,  or  a  partially  full,  or  a  partially  empty  buffer 
(depending  on  the  direction  of  rotation),  the  transition  would  not  represent  a  "valid" 
count  since  any  of  these  conditions  would  indicate  that  the  transition  was  due  to  a 
change  in  the  position  of  the  worm  without  a  corresponding  change  in  the  position  of 
the  wormgear.  Thus,  the  present  transition  would  be  the  result  of  hysteresis  due  to  the 
backlash  in  the  gear  train  and  the  transition  would  be  "invalid".  Such  a  transition  would 
cause  the  contents  of  the  hysteresis  buffer  to  be  modified  appropriately.  A  more  com- 
plete discussion  of  this  topic  is  contained  in  Chapter  IV.  The  shift  register  and  associ- 
ated logic  could  be  built  from  common  TTL  devices  readily  available  at  the  NPS. 

Once  a  count  had  been  determined  to  be  valid,  an  U/D  counter  would  be  used 
to  keep  a  running  total  of  the  number  of  counts.  Again,  such  a  device  could  be  built 
using  readily  available  TTL  devices  such  as  the  74LS168A,  Synchronous  4-Bit  Up/Down 
Decade  Counter,  or  the  74LS169A,  Synchronous  4-Bit  Up/Down  Binary  Counter.  The 
output  from  the  U/D  counter  would  then  be  used  as  an  address  to  "look  up"  a  prede- 
termined number  stored  in  an  EPROM. 

This  design  approach  was  considered  relatively  straightforward,  and  at  least  in- 
itially seemed  like  a  viable  option.  Its  major  advantage  was  that  it  was  conceptually 
quite  simple.    This  simplicity  had  a  price  though;  it  would  have  been  very  hardware  in- 
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tensive  and  consequently  would  have  been  a  very  inflexible  design.  For  example,  if  at  a 
later  date  the  use  of  an  arbitrary  reference  was  desired,  additional  hardware  would  have 
to  be  added  to  the  signal  conditioner  so  that  the  counter  could  be  initialized  to  the  ar- 
bitrary starting  point.  Since  all  of  the  processing  would  have  to  be  done  in  hardware, 
even  a  minor  modification  in  the  system  could  necessitate  a  major  design  revision.  An- 
other consideration  was  that  saving  in  excess  of  51,000  unique  positions  in  the  EPROM 
presented  a  nontrivial  problem  that  would  need  to  be  solved  if  this  technique  was  used. 

2.  Up/down  counter  and  multiplication 

This  is  very  similar  to  the  previous  case,  differing  only  in  that  instead  of  looking 
up  a  predetermined  position,  in  a  memory  device,  a  multiplier  would  be  used  to  multiply 
the  output  of  the  U/D  counter  by  a  predetermined  constant.  As  an  example,  if  exper- 
imental results  indicated  that  the  shaft  encoders  generated  one  pulse  for  every 
0.00703125°  that  the  camera  was  displaced,  then  each  time  a  valid  count  was  received, 
the  updated  count  would  need  to  be  multiplied  by  0.00703125  in  the  final  stage  of  the 
signal  processor.  The  result  would  be  the  new  position.  Again,  while  conceptually 
simple  this  idea  had  some  significant  disadvantages.  Even  more  hardware  intensive  than 
the  first  approach,   this  design  would  also  have  extremely  limited  flexibility. 

Accomplishing  the  multiplication  would  have  posed  a  formidable  task.  The 
scale  factor  would  have  to  be  written  as  some  integer  (e.g.,  0.00703125  would  become 
703125,  or  70323.  or  7031,  etc.)  depending  on  the  desired  accuracy.  The  count,  already 
an  integer,  would  be  multiplied  by  the  constant  and  the  correct  position  of  the  decimal 
point  would  have  to  be  determined.  Locating  the  decimal  point  would  be  a  relatively 
simple  task,  but  multiplication  of  two  numbers  such  as  51,000  and  70,313  would  not  be 
as  easy.  At  least  one  16  bit  by  16  bit  binary  multiplier  (i.e.,  TRW's  MPY016H)  is  cur- 
rently available,  but  since  the  number  70313  cannot  be  represented  in  binary  by  less  than 
17  bits,  the  multiplication  could  have  been  accomplished  in  either  of  two  ways.  One 
solution  would  have  been  to  perform  the  multiplication  in  two  or  more  stages.  Alter- 
natively, 70313  could  be  "rounded"  to  7031.  The  second  option  would  create  a  cumu- 
lative round-off  of  about  (1.28  x  10"3)°  per  360°  rotation  (assuming  51,200  pulses  per 
360°  ).  This  round-off  error  would  probably  have  been  acceptable,  but  the  complexity 
and  limited  flexibility  of  either  multiplication  scheme  made  the  U'D  counter  and  multi- 
plication an  unacceptable  candidate  for  the  signal  processing  subsystem. 

3.  Add/subtract 

A  third  design  concept  considered  the  elimination  of  the  U/D  counter  alto- 
gether.   The  same  logic  proposed  for  use  in  the  previous  two  designs  could  have  been 
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used  to  check  the  validity  of  a  count  and  to  determine  the  direction  of  rotation.  How- 
ever, instead  of  valid  counts  being  sent  to  an  U/D  counter  as  before,  these  counts  would 
now  signal  an  adder  to  add  or  subtract  a  predetermined  constant  from  the  running  total. 
Just  as  before,  this  simple  idea  could  probably  have  been  made  to  work  at  least  once, 
but  its  usefulness  as  a  part  of  a  larger  system  would  certainly  have  been  limited.  The 
large  number  of  components  required  to  realize  this  design  would  have  increased  the 
probability  of  failure,  complicated  troubleshooting  and  reduced  overall  flexibility. 

4.  Microcomputer 

If  the  signal  processing  subsystem  was  built  around  a  microcomputer  (PC),  vir- 
tually all  of  the  disadvantages  associated  with  the  previously  discussed  approaches  would 
be  eliminated.  Since  all  of  the  logic  could  be  implemented  in  software,  modifications  to 
the  system  would  be  relatively  simple  to  make,  and  the  system's  flexibility  would  be  en- 
hanced. However,  dedicating  a  microcomputer,  even  an  inexpensive  model,  to  the  signal 
processing  tasks  for  this  measurement  system  was  considered  overkill,  and  timesharing 
with  one  of  the  PC's  already  in  service  was  possible,  but  not  considered  practical  or 
convenient  since  these  microcomputers  had  already  been  dedicated  to  a  variety  of  tasks. 

5.  Microprocessor 

One  final  option  for  the  signal  processor  remained.  Microprocessors  are  rela- 
tively inexpensive  and  powerful  and  are  available  in  a  wide  variety  of  makes  and  models. 
If  a  microprocessor  was  used  instead  of  a  microcomputer  or  a  straight  hardware 
processor,  the  "nice  to  have"  requirements  such  as  flexibility,  ease  of  modification  and 
capacity  for  expansion,  as  well  as  the  required  signal  processing  functions  could  all  be 
satisfied.  On  the  other  hand,  microprocessors  have  one  distinct  disadvantage;  they  are 
not  user  friendly.  The  use  of  a  microprocessor  implied  countless  hours  spent  tracking 
individual  bits,  debugging  assembly  language  code,  studying  timing  diagrams,  etc..  No 
matter  how  distasteful  the  thought,  however,  a  microprocessor  was  clearly  the  best  way 
to  perform  the  signal  processing  functions  of  the  measurement  system. 

As  with  the  selection  of  the  transducer,  once  the  basic  design  approach  had  been 
determined,  selection  of  a  specific  device  was  a  relatively  straight  forward  task.  The 
choice  of  one  microprocessor  over  another  was  a  function  of  the  processor's  ability  to 
perform  the  required  tasks,  cost  effectiveness  and  availability.  Motorola's  MC68705U3 
seemed  to  satisfy  all  of  these  requirements.  The  MC6S705U3  is  a  four  kilobyte  EPROM 
microprocessor,  built  using  HMOS  (high-density  XMOS)  technology  with  an  eight  bit 
architecture.  The  "68705"  operates  on  a  5.0  volt  dc  supply,  has  112  bytes  of  on  chip 
RAM,  four  vectored  interrupts,  24  TTL.  CMOS  compatible  bidirectional  I/O  lines  (eight 
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lines  are  LED  compatible),  eight  dedicated  input  lines  and  an  internal  eight  bit  timer 
with  a  seven  bit  programmable  prescaler.    [Ref.  10:  p.  1] 

In  Ref.  10  Motorola  advertises  the  following  software  features: 

Programming  language  similar  to  the  6800  family. 

Byte  efficient  instruction  set. 

Easy  to  program. 

True  bit  manipulation. 

Bit  test  and  branch  instructions. 

Versatile  interrupt  handling. 

Powerful  indexed  addressing  for  tables. 

Versatile  index  register. 

A  full  set  of  conditional  branches. 

Memory  usable  as  registers/flags. 

Single  instruction  memory  examine;  change  capability. 

Ten  powerful  addressing  modes. 

All  addressing  modes  apply  to  EPROM,  RAM  and  I/O. 

One  key  advantage  to  using  the  MC68705U3  was  that  one  of  the  micro- 
processors, and  a  Motorola  M68705EVM  (the  evaluation; programming  module  for  the 
M6805  family  of  devices)  were  both  available  for  immediate  use  at  the  NPS.  The  fact 
that  the  68705  utilized  HMOS  technology  suggested  that  it  should  be  a  relatively  low 
cost  microprocessor.  In  fact,  except  for  the  price  of  a  phone  call,  a  second  micro- 
processor was  obtained  free  of  charge  from  a  local  electronics  wholesaler.  Additional 
microprocessors,  to  be  used  as  replacements  and  as  backup  devices  were  ordered  for 
about  S20.00  each. 

One  potential  problem  with  using  a  microprocessor  begged  checking  prior  to 
proceeding.  Initial  measurements  of  the  camera's  maximum  rotation  velocity  produced 
the  following  results. 

UpAMmax)-  1-0  rpm  (10) 

w77Lr(max)-°-5rPm  (11) 

Again  the  requirements  for  the  pan  axis  presented  the  most  stringent  design  limitations. 
Since  the  optical  shaft  encoders  were  anticipated  to  deliver  51,200  PPR  (  1024  x  50)  the 
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microprocessor  on  the  pan  axis  had  to  be  capable  of  processing  51,200  pulses  minute 
(1.172  ms  /  pulse).  The  MC68705U3  is  designed  to  operate  with  an  oscillator  frequency 
(fosc)  of  between  0.4  MHz  and  4.4  MHz  and  has  an  instruction  cycle  time  (4/fosc)  of  be- 
tween 0.950  ^s  and  10  fxs.  Assuming  that  a  4.0  MHz  clock  was  used,  the  instruction 
cycle  time  would  be  1.0  /j.s.  This  would  mean  that  the  processing  of  each  pulse  would 
have  to  be  accomplished  in  no  more  than  1 172  instruction  cycles  to  ensure  that  no  pulses 
would  be  missed. 
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III.     DESIGN 

A.  GENERAL 

The  schematic  diagrams  for  the  measurement  system  are  shown  in  Appendix  A; 
Appendix  B  contains  copies  of  the  printed  circuit  board  plans.  Before  describing  the 
detailed  operation  of  each  of  the  individual  components  of  the  measurement  system,  a 
brief  overview  of  its  basic  theory  of  operation  is  in  order.  The  measurement  system  is 
actually  two  separate  systems  operating  independently.  The  system  designed  to  measure 
the  azimuth  or  pan  angle  will  subsequently  be  referred  to  as  the  "Pan  System",  and  the 
other  system,  designed  to  measure  the  elevation  or  tilt  angle,  will  be  referred  to  as  the 
"Tilt  System''.  However,  because  the  two  systems  are  quite  similar  the  discussion  which 
follows  will  only  specifically  describe  the  operation  of  both  systems  where  their  opera- 
tion differs. 

In  the  most  general  terms,  the  measurement  system  shown  in  Figure  2  on  page  6 
uses  two  microprocessors  to  count  the  pulses  generated  by  the  incremental  shaft  encod- 
ers, and  to  provide  output  signals  to  the  display  devices.  The  counting  function  per- 
formed by  each  microprocessor  involves  determining  the  direction  of  rotation  and 
determining  whether  each  count  is  "valid".  Valid  counts  are  encoder  pulses  which  result 
from  the  displacement  of  the  camera  servo,  while  invalid  counts  are  a  result  of  the 
hysteresis  in  the  gear  train.  The  number  of  valid  counts  is  directly  proportional  to  the 
angular  displacement  of  the  camera  axis. 

Both  of  the  displays  are  capable  of  presenting  the  position  information  in  two  basic 
forms.  In  the  Count  Mode  they  display  the  number  of  pulses  that  have  been  detected, 
and  in  the  Position  Mode  they  display  the  angle  in  degrees  that  the  number  of  pulses 
represents.  A  third  display  mode,  which  is  a  combination  of  the  first  two,  is  also  avail- 
able. In  the  third  mode,  referred  to  as  the  "Blinking  Mode",  the  display  will  alternately 
display  the  count  and  the  angle. 

B.  SHAFT  ENCODER  AND  LINE  DRIVER 

Figure  11  shows  the  basic  components  of  the  HEDS-6000  incremental  optical  shaft 
encoder.  The  encoder  is  approximately  56  mm  in  diameter  and  20  mm  deep.  The  code 
wheel  assemblies  for  the  HEDS-6000  J06  encoders  are  designed  to  mount  on  0.25  in. 
shafts.  Since  the  mounting  surface  shown  in  Figure  1 1  is  not  part  of  the  encoder  kit, 
and  did  not  existed  on  either  of  the  worm  axes,  two  such  surfaces  were  machined  in  the 
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Physics  Department  Shop  and  attached  to  one  end  of  each  of  the  worms.  Each  surface 
has  a  0.25  in.  diameter  shaft  to  which  one  of  the  code  wheel  assemblies  is  attached.  Two 
sheet  metal  brackets,  also  made  in  the  Physics  Department  Shop,  are  bolted  to  the  servo 
frame.  The  encoder  bodies  are  mounted  to  these  brackets.  Figure  12  shows  the  shaft 
encoders  mounted  in  the  camera  servo.   [Ref.  9:  p.l] 


EMITTER 
END  PLATE 


CODE  WHEEL 
ASSEMBLY 


PHASE       ENCODER 
PLATE  BODY 


MOUNTING 
SURFACE 


Figure   11.      HEDS-6000  Series  Encoder  Kit:     From  Ref  9:  p.6. 

Also  seen  in  Figure  12  is  a  printed  circuit  board  mounted  between  the  two  optical 
shaft  encoders.  Each  of  the  encoders  is  electrically  connected  to  the  board  via  a  separate 
ten  wire  ribbon  cable.  The  power  and  the  output  signals  from  the  shaft  encoders  are 
transmitted  through  these  cables.  A  sketch  of  the  ribbon  cable  connector  and  the  pinout 
for  the  connector  are  shown  in  Figure  13.  Each  connector  is  attached  to  a  ten  pin 
header  on  the  printed  circuit  board.  Pins  2,  7  and  9  are  connected  to  a  +  5.0  Vdc  power 
supply  external  to  the  camera  servo.  A  description  of  the  power  supply  is  given  later  in 
this  chapter.  Pins  3,  4,  5  and  6  are  connected  to  the  power  supply  ground.  The 
HEDS-6000  does  not  have  an  index  pulse,  therefore  pin  10  is  not  connected. 

The  remaining  two  pins  on  each  header  connect  the  output  channels  of  the  shaft 
encoders  to  two  74S140  line  drivers.  Each  74S140  is  a  dual  four-input  NAND  gate 
50-Ohm  line  driver.  The  line  drivers  are  powered  by  the  same  supply  as  the  encoders. 
They  serve  as  bulfers  between  the  encoders  and  the  transmission  lines  which  are  used  to 
transmit  the  encoder  signals  to  the  signal  conditioner.    The  line  drivers'  typical  high 
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Figure  12.  Modified  Camera  Servo:  (a)  Optical  shaft  encoder  used  to  measure 
Pan  axis  displacement,  (b)  Optical  shaft  encoder  used  to  measure  Tilt 
axis  displacement,  (c)  Ribbon  cable,  (d)  Printed  circuit  board. 

output  current  is  10  mA  and  the  maximum  is  18  mA.  Resistance  in  the  transmission 
line  was  measured  to  be  approximately  35  £2,  and  to  be  on  the  safe  side  a  10  Q  con- 
nector loss  was  assumed.  The  voltage  drop  due  to  an  18  mA  current  through  a  45  Q 
resistance  is  0.81  V.  A  "voltage  high"  signal  received  at  the  signal  conditioner  should 
therefore  be  about  4.19  V.  This  is  well  above  the  maximum,  positive-going  threshold 
voltage  specification  of  2.0  V  for  the  7414  Schmitt  triggers,  which  are  used  to  receive  the 
signals  at  the  signal  processor.   [Ref.  11:  pp.  5-73,  5-74,  6-44] 

C.     ENCODER-MICROPROCESSOR  INTERFACE 

The  signals  transmitted  by  the  two  line  drivers  are  Channels  A  and  B  of  each  of  the 
shaft  encoders.  These  signals  contain  the  raw  data  which  the  signal  processor  converts 
into  position  information.  Three  pairs  of  multiple  pin  connectors  are  used  in  the 
encoder-microprocessor  interface.      The  pinouts  for  these   connectors   are  shown  in 
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Figure  13.      Encoder  Connector  Specifications:     From  Ref.  9:  p.  6. 

Figure  14.  Each  of  the  four  signals  is  received  at  the  signal  processor  by  a  7414  Schmitt 
trigger  which  is  used  to  "clean  up"  the  signal.  The  Schmitt  triggers  lower  the  system's 
susceptibility  to  errors  caused  by  slow  state  transitions  and  increase  the  signals'  fan  out 
capabilities  [Ref.  7:  p.  13]. 

The  output  of  each  Schmitt  trigger  is  routed  to  an  input  port  of  the  appropriate 
microprocessor.  Each  Channel  A  signal  is  also  the  input  to  an  edge  detector.  The  edge 
detectors  each  consist  of  three  7414  inverters,  a  74LS86  EXOR  gate  and  a  47  nF 
capacitor,  configured  in  the  manner  shown  in  Figure  15.  This  configuration  causes  the 
interrupt  line  to  go  low  for  approximately  2  /xs  each  time  Channel  A  transitions  from 
low  to  high  or  from  high  to  low.  Since  an  oscillator  frequency,  fosc,  of  4.0  MHz  is  being 
used,  the  interrupt  pulse  width,  tWL,  must  be  greater  than  or  equal  to  1.25  us  [Ref.  10: 
p.  3].  The  value  of  the  capacitor  required  to  achieve  the  2  us  delay  was  determined  ex- 
perimentally. 

D.     SWITCHES 

The  measurement  system  has  10  switches  that  allow  the  operator  to  control  specific 
functions  of  the  signal  processors  and  the  displays.  Figure  16  shows  the  physical  lo- 
cation of  these  switches  on  the  control  panel.  Switches  SW1(P)  and  S\V1(T)  control  the 
reset  lines  to  the  microprocessors.  Switches  SW2(P),  SW2(T)  and  SW5  control  the  dis- 
play mode.  The  Function  and  Set  switches;  (S\V3(P),  SW3(T),  SW4(P)  and  SW4(T)) 
allow  the  user  to  change  the  length  of  the  hysteresis  buffer  in  the  microprocessor.    The 


31 


< 

Cm 


CO 


Cm 


< 

6 


6 


S 


CQ 


U 


I  I 


■  6 


o 


Ed 


p      O 
CO      o 


s  3 

Cm      JZ 


CQ 

6 

Cm 


to        v© 


00        CTv 


> 

+ 


cm    m 


Cri 
O 
CO 


s 


I  I 

m    a; 
co     Cm 


3 

Cm 


O 
Cm 


§ 


9 


Figure  14.      Encoder-Microprocessor  Connector  Specifications 
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Figure  15.      Interrupt  Interface:     After  Ref  7:  p.  14. 

master  power  switch  is  SW6.    Table  2  identifies  the  switches  by  name,  description  and 
function. 

Any  mechanical  switch  will  "bounce*'  or  "chatter"  when  it  is  thrown,  and  since  the 
operation  of  the  signal  processor  depends  on  the  number  of  times  that  the  Display  Mode 
and  Set  switches  change  position,  these  switches  had  to  be  "dcbounced".  A  very  simple 
but  effective  way  to  do  this  is  with  an  RS  latch.  Switches  SW2(I>),  SW2(T),  SW4(P)  and 
SW4(T)  are  each  debounced  in  this  manner.  Each  latch  is  made  from  two  74SO0  NAM) 
gates  connected  in  the  manner  shown  in  Figure  17.   [Refs.  13:  pp.  132-135,  12  :  pp.  3,4] 
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Figure  16.      Control  Panel 


E.     MC68705U3 
1.     General 

The  two  40  pin  MC6S705U3  microprocessors  (MPU's)  are  the  heart  of  the 
measurement  system.  With  the  exception  of  the  light  test  signal,  every  signal  in  the 
system  is  either  part  of  the  input  to  one  of  the  MPU's  or  part  of  their  output.  The 
MPU's  were  programmed  using  the  assembly  language  syntax,  assembler  directives  and 
instruction  set  for  the  M6S05  family  of  microprocessors  which  are  described  in  Ref.  14. 
The  Pan  and  Tilt  programs  are  listed  and  their  operation  is  described  in  Appendix  D. 
The  pin  assignments  for  the  MC6S705U3  are  shown  in  Figure  IS.  Table  3  briefly  de- 
scribes the  purpose  of  each  pin  and  the  actual  connections  for  the  two  MPU's. 
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Figure  17.      Debouncing  circuit:     After  Ref  12:  p.  4. 

2.     Memory  Map 

a.     Input  J  Output  (I/O) 

The  memory  map  for  the  MC68705U3  is  shown  in  Figure  19.  The  digits 
following  a  "S"  are  the  hexadecimal  representation  of  the  address  for  a  specific  memory 
location.  The  data  registers  occupy  the  first  four  memory  locations  of  each  MPU.  Thus 
the  information  written  into  the  registers  at  S000,  S001  and  S002  is  written  to  the  output 
ports  A,  B  and  C  respectively.  Port  D,  at  address  S003,  is  an  input  only  port  as  indicated 
in  Table  3.  In  order  to  determine  the  state  of  the  input  lines,  the  contents  of  the  register 
at  S003  must  be  read  by  the  MPU.  Registers  S004,  S005  and  S006  are  the  data  direction 
registers  (DDR's)  for  Ports  A,  B  and  C  respectively.  Because  all  three  ports  are  used  as 
"output  only"  ports,  in  this  application,  the  DDR's  are  all  established  as  such  by  an 
initialization  routine  performed  by  the  MPU's  during  their  initial  power-up  and  after 
each  external  reset.   [Ref.  10:   pp.  5,  12,  14] 

Pin  18  of  the  MPU  can  be  used  as  either  a  general  purpose  input  line  or  as 
an  interrupt  line.  The  primary  interrupt  line  on  each  MPU  is  used  to  signal  the  occur- 
rence of  a  state  transition  on  Channel  A.  Pin  18  is  used  as  a  second  interrupt  line  to 
signal  a  display  mode  change  request  from  the  operator.  The  Miscellaneous  Register 
(MR)  at  address  SOA  is  used  to  control  the  operation  of  the  second  interrupt  line 
(INT2)  .    In  order  to  establish  pin  18  as  an  interrupt  line,  bit  6  of  the  MR  is  cleared  by 


the  Initialization  Routine.  The  IXT2  Interrupt  Request  Bit,  bit  7  of  the  MR,  is  cleared 
by  default  upon  reset.  It  is  set  when  a  falling  edge  is  detected  on  the  Display  Mode  line 
which  is  connected  to  pin  18.  When  this  occurs  and  bit  6  of  the  MR  is  cleared,  an  in- 
terrupt request  is  generated.    This  interrupt  request  causes  the  display  mode  to  change. 
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Table  2.     SIGNAL  PROCESSOR  AND  DISPLAY  SWITCHES 


NAME 

DESCRIPTION  AND  FUNCTION 

PAN  RESET 
(SWI(P)) 

Momentary  action  push  button  switch:    Resets  the  Pan 
Microprocessor.   Causes  the  Pan  Display  to  be  reset  to 
zero. 

TILT  RESET 
(SW1(T)) 

Same  as  SW1(P)  except  it  affects  the  Tilt  System  only. 

PAN  DISPLAY  MODE 
(SW2(P)) 

Single  pole  double  throw  toggle  switch:   Each  time  the 
switch  position  is  changed  the  Pan  Display  toggles  from 
Count  mode,  to  Position  Mode,  to  Blinking  Mode,  to 
Count  Mode,  etc.. 

TILT  DISPLAY  MODE 
(SW2(T» 

Same  as  SW2(P)  except  it  affects  the  Tilt  Display  only. 

FUNCTION 

(HYSTERESIS) 

(SW3(P)) 

Single  pole  double  throw  switch:   When  closed,  causes 
the  "Function"  line  of  the  Pan  Microprocessor  to  go 
low  and  causes  the  size  of  the  hysteresis  buffer  to  be 
displayed  on  the  Pan  Display.    Enables  SW4(P). 

FUNCTION 

(HYSTERESIS) 

(SW3(T)) 

Same  as  SW3(P)  except  it  affects  the  Tilt  System  only. 

SET  HYSTERESIS 
(SW4(P» 

Single  pole  double  throw  switch:    Inoperable  unless 
SW3(P)  is  closed.    If  SW3(P)  is  closed,  each  time  the 
position  of  SW4(P)  is  changed  the  length  of  the 
hysteresis  buffer  is  incremented  by  one.    Maximum 
buffer  length  is  25.   Toggling  SWT4(P)  when  the  buffer 
length  is  25  will  cause  the  buffer  length  to  be  reset  to 
zero. 

SET  HYSTERESIS 
(SW4(T)) 

Same  as  SW4(P)  except  it  affects  the  Tilt  Hysteresis 
buffer. 

LIGHT  TEST 
(SW5) 

Single  pole  single  throw  switch:   When  closed,  lines  1. 
2,  7,  8,  10,  11  and  13  on  each  of  the  LED  displays  will 
go  low.    Unless  an  element  is  burned  out,  every  digit  in 
both  displays  should  be  an  eight. 

POWER 

(SW6) 

Single  pole  single  throw  switch:   When  closed,  applies 
+  5.0  V  dc  power  to  the  signal  processors  and  the  dis- 
plays. 
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Figure  18.      MC68705U3  Pin  assignments:     From  Ref.  10:  p.  1. 

Once  bit  7  has  been  set  by  an  interrupt,  it  must  be  cleared  by  software  to  avoid  repeated 
and  unwanted  interrupts  from  occurring.    This  task  is  performed  by  the  Mode  Change 
Routine  in  each  EPROM.   [Ref.  10:  pp.  1,  10,  13,  15] 
b.     Timer 

The  operator  can  cause  either  or  both  of  the  displays  to  "blink"  by  using 
the  Display  Mode  Switches,  S\V2(P)  and  SW2(T).  When  one  of  the  systems  has  its 
display  in  the  Blinking  Mode,  the  associated  MPU  uses  its  timer  to  generate  a  timer  in- 
terrupt request  every  second.  The  interrupt  request  causes  the  MPU  to  execute  the 
Mode  Change  Routine.  A  block  diagram  of  the  timer  is  shown  in  Figure  20.  The  timer 
consists  of  an  eight-bit  counter  which  is  decremented  toward  zero  by  the  fcw  input. 
When  the  counter  reaches  zero,  it  sets  the  Timer  Interrupt  Request  Bit  (T1R)  of  the 
Timer  Control  Register  (TCR),  and  a  timer  interrupt  request  is  generated  unless  the 
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Figure  19.      MC68705U3  Memory  Configuration:     From  Rcf.  10:  p.  5. 

Timer  Interrupt  Mask  Bit  (TIM)  of  the  TCR  is  set.    A  brief  description  of  each  of  the 
timer  registers  and  their  configuration  follows. 

(1)  Timer   Data  Register   (TDR).     The    TDK  is  the  eight-bit  counter 
which  sets  the  TIR  bit  of  the  TCR  when  it  decrements  to  zero. 

(2)  Timer  Control  Register.     The  contents  of  the  TCR  determine  the 
general  operation  of  the  timer. 

•  Bit  7,  Timer  Interrupt  Request  (TIR),  signals  a  TDR  underflow  when  it  is  set  and 
will  cause  a  timer  interrupt  request  if  the  TIM  bit  of  the  TCR  is  clear.  The  TIR 
is  cleared  by  the  MPU  reset  or  by  program  control. 

•  Bit  6,  Timer  Interrupt  Mask  (TIM),  inhibits  a  timer  interrupt  request  when  it  is  set. 
It  is  set  by  external  reset  or  program  control  to  inhibit  the  Blinking  Mode,  and  is 
cleared  by  software  when  the  Blinking  Mode  is  requested  by  the  operator. 

•  Bit  5,  External  or  Internal  Clock  Select  (TIN),  is  used  to  select  the  timer  clock 
source.    Since  the  internal  clock  is  used  in  this  application,  the  FIN  bits  of  both 
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Table  3.     MPU  CONNECTIONS 


Pin 

Name 

Description 

1 

V55 

Ground 

2 

When  RESET  is  pulled  low  program  execution  halts,  all  variables  are 
reinitialized  and  the  Pan  display  is  set  to  zero.    S\V1(P)  controls  the 
RESET  line  on  the  Pan  MPU. 

RESET 

3 

INT 

Allows  asynchronous  interruption  of  the  processor.   When  INT  is 
pulled  low  by  the  Count  Edge  Detector  the  MPU  executes  the 
"Count  Routine". 

4 

Vcc 

+  5  V  dc  power  connection. 

5 

EXTAL 

External  clock  input.   Connected  to  a  4.0  MHz  external  clock  which 
provides  the  MPU  system  clock. 

6 

XTAL 

Crystal  clock  input.    Connected  to  ground  since  an  external  clock  is 
used. 

7 

\Pp 

Programming  voltage  pin.   Connected  to  Vcc  for  normal  operation. 

8 

Timer 

External  timer  control  input.    Connected  to  Vcc  since  the  internal 
timer  is  used. 

Port  C 

General  Purpose  I  0  lines. 

9 

PCO 

The  two  least  significant  digits  in  the  display  are  represented  in  bi- 
nary coded  decimal  (BCD)  by  these  eight  lines. 

10 

PCI 

11 

PC2 

12 

PC3 

13 

PC4 

14 

PC5 

15 

PC6 

16 

PC7 

Port  D 

General  Purpose  input  lines. 

17 

PD7 

PD7  is  the  Channel  A  input  to  the  MPU. 

PD6  is  used  as  a  second  interrupt  line. 

When  PD6  goes  low  the  MPU  changes  display  modes. 

PD5  is  the  Channel  B  input  into  the  MPU. 
PD4  is  the  Function  input  into  the  MPU. 
PD3  is  the  Set  input  into  the  MPU. 
PD2-PD0  are  not  used  and  are  tied  to  ground. 

18 

PD6 
INT2 

19 

PD5 

20 

PD4 

21 

PD3 

OT 

X.J- 

PD2 

23 

PD1 

24 

PDO 
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Table  4.     MPU  CONNECTIONS  (CONPD.) 


Pin 

Name 

Description 

Port  B 

General  Purpose  I  0  lines  (LED  compatible). 

25 

PBO 

The  most  significant  digit  is  represented  in  BCD  by  PB0-PB3  except 
on  the  Tilt  MPU  where  these  lines  are  connected  to  ground. 

PB4  determines  which  digits  in  the  display  are  blanked. 

PB5  is  not  used.   Connected  to  ground. 

PB6  determines  the  presence  or  absence  of  the  display  minus  sign. 

PB7  determines  the  presence  or  absence  of  the  display  decimal  point. 

26 

PB1 

27 

PB2 

28 

PB3 

29 

PB4 

30 

PBS 

31 

PB6 

32 

PB7 

Port  A 

General  Purpose  I.O  lines. 

33 

PAO 

The  third  and  fourth  least  significant  digits  are  represented  in  BCD 
by  these  eight  lines. 

34 

PA1 

35 

PA  2 

36 

PA  3 

37 

PA4 

38 

PA5 

39 

PA6 

40 

PA  7 

MPU's  are  always  cleared.    For  the  same  reason  the  Timer  pins  are  connected  to 
Vcc  (see  Table  3). 

•  Bit  4,  External  Enable  (TEE),  is  not  used  by  the  measurement  system.   By  keeping 
the  TEE  clear  at  all  times,  the  68705 's  internal  timer  is  used  exclusively. 

•  Bit  3,  Prescaler  Clear  (PSC),  is  not  used  in  this  application;  always  cleared. 

•  Bits  2-0,  Prescaler  Select  (PS2,  PS1  and  PSO),  are  always  set  during  program  exe- 
cution.  This  causes  the  internal  timer  signal  frequency  to  be  divided  by  128. 

(3)     Mask  Option  Register  'MORj.     Unlike  the  TDR  and  TCR  the  MOR 
is  not  software  programmable;  instead,  it  is  implemented  in  EPROM. 

•  Bit  7,  the  Clock  bit,  is  cleared  to  allow  operation  of  the  external  4.0  MHz  clock. 

•  The  Timer  Option  bit  (TOPT),  bit  6,  is  also  cleared  in  this  application.    This  per- 
mits the  TCR  to  be  software  programmable. 

•  Bit  5  is  cleared  to  permit  the  use  of  the  internal  clock  with  the  timer. 

•  Bits  4  and  3  are  not  used. 
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Figure  20. 


MC68705U3  Timer  Functional  Block  Diagram.:     From  Ref.  10:  p. 
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•    Bits  2-0  are  all  set  and  serve  the  same  function  as  PS2,  PS1  and  PSO  bits  of  the 
TCR.    [Ref.  10:  pp.  6-8,  13-15] 

3.  RAM 

The  MC68705U3  has  112  bytes  of  RAM.  The  112  bytes  includes  31  bytes  that 
can  be  used  for  the  stack.  Use  of  the  stack  is  quite  limited.  During  interrupts  it  is  used 
to  save  the  contents  of  the  CPU  registers  and  the  program  counter.  During  subroutine 
calls  only  the  program  counter  is  saved.  The  user's  program  has  no  other  access  to  the 
stack.  The  programs  written  for  each  of  the  MPU's  require  less  than  25%  of  the  avail- 
able RAM.  The  Pan  MPU  uses  27  of  the  112  available  bytes  and  the  Tilt  MPU  uses 
only  22  bytes.  The  programs  listed  in  Appendix  D  explain  the  function  and  give  the 
location  in  memory  for  each  of  the  variables.   [Ref  10:  p.  5] 

4.  ROM 

The  3776  bytes  of  user  EPROM  in  the  MC68705U3  are  divided  into  three  sep- 
arate blocks  in  the  memory.  Page  Zero  User  EPROM  is  the  ROM  located  between  ad- 
dress S0S0  and  SOFF.  Because  these  addresses  are  only  one  byte  long,  instructions 
located  in  Page  Zero  ROM  can  be  referenced  with  addressing  modes  not  permitted  with 
instructions  located  in  other  parts  of  the  memory.  Between  address  S100  and  SF37  is  the 
User  Main  EPROM.  This  portion  of  the  memory  in  each  MPU  contains  the  vast  ma- 
jority of  the  signal  conditioning  programs.  Located  in  another  portion  of  the  EPROM 
are  the  Interrupt  Vectors.  In  each  of  these  locations  is  the  address  of  the  first  instruction 
the  MPU  is  to  execute  when  a  particular  interrupt  occurs. 

As  with  the  RAM  only  a  fraction  of  the  available  EPROM  has  been  used  in  this 
application.  The  Pan  MPU  uses  899  bytes  of  the  3776  available  and  the  Tilt  MPU  uses 
only  767  bytes.  Since  both  programs  are  so  small,  one  could  reasonably  ask  why  the  two 
programs  were  not  both  put  in  one  MPU.  The  primary-  problem  with  this  idea  is  that 
each  microprocessor  can  perform  only  one  operation  at  a  time.  As  indicated  at  the  end 
of  Chapter  II,  if  the  camera  servo  is  rotating  about  its  vertical  axis  at  its  maximum  ve- 
locity of  1  rpm,  the  Pan  signal  conditioner  must  be  capable  of  counting  and  displaying 
51,200  counts  per  minute.  Using  a  4.0  MHz  clock  this  allows  the  MPU  1172ms  to  count 
each  pulse.  Similarly  the  Tilt  MPU  has  1758/zs  to  count  each  pulse  when  the  camera  is 
rotating  at  its  maximum  velocity  about  the  horizontal  axis.  Assuming  that  the  camera 
is  rotating  at  its  maximum  velocity  on  both  axes  at  the  same  time,  and  one  MPU  is  being 
used  to  count  the  pulses  from  both  encoders,  the  MPU  needs  to  count  76.S00  pulses  per 
minute,  which  only  allows  7S1.3  /j.s  per  pulse.    The  Pan  MPU  currently  requires  a  max- 
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imum  of  1032  instruction  cycles  or  1032ms  to  count  a  single  pulse,  and  the  maximum 
execution  time  for  a  single  pulse  on  the  Tilt  axis  is  825^s.   Thus,  a  single  68705  lacks  the 
computational  speed  required  to  ensure  that  no  counts  would  be  missed  if  it  was  used 
to  process  the  data  from  both  encoders. 
5.     Central  Processing  Unit  (CPU) 

The  CPU  of  the  M6805  Family  is  implemented  independently  from  the  I/O  or 
memory  configuration.  Consequently  it  can  be  treated  as  an  independent  central 
processor  communicating  with  I/O  and  memory  via  internal  address,  data  and  con- 
trol buses.   [Ref  10:  p.  6] 

The  CPU  has  five  registers  that  are  available  for  use  by  the  operator.     The 
function  of  each  of  these  is  described  below. 

•  The  Accumulator  (A)  is  a  general  purpose  data  register  used  for  arithmetic  calcu- 
lation and  data  manipulation. 

•  The  Index  Register  (X)  can  be  used  as  a  second  accumulator  but  is  generally  used 
for  the  indexed  addressing  mode.  In  the  indexed  addressing  mode  an  effective  ad- 
dress is  created  by  adding  the  contents  of  X  to  a  number  provided  by  the  instruc- 
tion. 

•  The  Program  Counter  (PC)  contains  the  memory  address  of  the  next  instruction  to 
be  executed  by  the  MPU. 

•  The  five  bits  of  the  Condition  Code  Register  (CCR)  keep  information  concerning 
he  results  of  the  last  instruction  executed  by  the  MPU.  Reference  14  gives  a  de- 
ailed  description  of  each  of  the  instructions  in  the  M6805  Family  Instruction  Set 

and  explains  the  effect  of  each  instruction  on  the  CCR.  A  brief  description  of  each 
bit  in  the  CCR  follows. 

The  Carry  (C)  bit  is  set  if  a  carry  or  a  borrow  was  generated  by  the  last  arith- 
metic instruction.   The  state  of  the  C  bit  can  be  software  controlled. 

The  Zero  (Z)  bit  is  set  if  the  result  of  the  last  arithmetic,  logic  or  data  manipu- 
lation instruction  was  zero. 

The  Negative  (N)  bit  is  set  if  bit  seven  of  the  result  of  the  last  arithmetic,  logic, 
or  data  manipulation  instruction  is  set. 

The  Half  Carry  (H)  bit  is  set  if  an  ADD  or  an  ADC  instruction  causes  a  carry 

to  occur  between  bits  3  and  4  of  the  result. 


The  Interrupt  Mask  (I)  bit  is  set  when  an  external  interrupt  (INT)  occurs.  If 
another  interrupt  occurs  (e.g.  Timer  Interrupt  or  INT2  )  when  the  I  bit  is  set, 
the  second  interrupt  is  latched  so  that  it  can  be  processed  as  soon  as  the  I  bit 
is  cleared.   The  I  bit  can  be  set  or  cleared  by  software. 

•  The  contents  of  the  Stack  Pointer  (SP)  are  the  address  of  the  next  available  location 
on  the  stack.  As  previously  discussed,  the  stack  is  only  used  to  keep  track  of  the 
PC  during  subroutine  branches,  and  all  of  the  CPU  redsters  during  an  interrupt. 
[Refs.  10:  p.  6.  14  :  pp.  14-15] 
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6.     Input 

Each  MPU  uses  six  input  lines.  Two  of  these  lines,  INT  and  INT2  ,  are  inter- 
rupt lines  that  detect  a  negative-going  edge  on  their  respective  lines.  The  other  four  lines 
are  general  purpose  input  lines  on  Port  D.  All  of  the  pins  on  Port  D  are  TTL  compatible 
which  made  the  hardware  design  relatively  straightforward.  The  electrical  character- 
istics for  the  input  pins  are  listed  on  p.  2  of  Ref.  10. 

The  general  operation  of  the  two  interrupt  lines  is  described  in  Table  3  on  page 
39.  Once  they  are  understood,  interrupts  are  a  simple  yet  powerful  tool.  Only  three  of 
the  four  interrupts  available  on  the  MC68705U3  are  used  by  the  Pan  and  Tilt  programs. 
The  software  interrupt  is  not  used.  When  the  MPU  is  interrupted,  current  program  ex- 
ecution is  halted,  the  contents  of  the  CPU  registers  are  placed  on  the  stack,  and  the 
MPU  fetches  the  contents  of  the  appropriate  interrupt  vector  from  memory.  After  the 
interrupt  vector  has  been  fetched,  the  PC  is  moved  to  that  address  and  execution  of  the 
interrupt  routine  begins.   There  is  no  ambiguity  when  an  external  interrupt  occurs  since 


there  is  a  dedicated  interrupt  vector  in  memory.  The  timer  interrupt  and  INT  however 
share  the  Timer  Interrupt  Vector.  When  one  of  these  interrupts  occurs,  the  interrupt 
routine  must  determine  the  source  of  the  interrupt  by  checking  the  TIR  bit  of  the  TCR 
and  bit  7  of  the  MR  to  determine  the  source  of  the  interrupt  [Ref.  10:  p.  11].  Normal 
program  execution  resumes  at  the  point  at  which  the  interrupt  occurred  when  the  inter- 
rupt routine  executes  a  return  from  interrupt  (RTI)  instruction. 

The  Function  and  Set  lines  on  pins  20  and  21  are  connected  to  the  Function  and 
Set  switches.  The  operation  of  these  switches  is  described  in  Table  2  on  page  36.  The 
remaining  two  input  lines  to  each  MPU  are  Channels  A  and  B  from  the  respective  shaft 
encoders.  The  MPU  programs  use  the  information  from  these  two  inputs  to  determine 
the  direction  of  rotation  and  to  identify  repeated  oscillations  about  a  single  transition. 
7.     Output 

Each  MPU  is  designed  to  provide  position  information  at  its  output  in  two  basic 
forms.  On  the  Pan  axis,  in  the  Count  Mode  a  number  between  -51,200  and  +51,200 
constitutes  the  output  while  in  the  Position  Mode  the  output  is  an  angle  between  0°  and 
360°.  A  five  digit  display  with  a  minus  sign  is  sufficient  for  the  count  display.  Using  a 
five  digit  display  with  a  decimal  point  in  the  Position  Mode  permits  the  angle  to  be  dis- 
played to  the  nearest  hundredth  of  a  degree.  This  resolution  is  not  quite  as  good  as  the 
resolution  of  the  shaft  encoders  (±0.007°);  however,  final  testing  of  the  measurement 
svstem  revealed  that  resolution   is  actuallv  limited  to  about  +  0.02°  on  the  Pan  axis  and 
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about  +  0.14°  on  the  Tilt  axis.  The  five  digit  display  is  therefore  completely  adequate 
for  this  system. 

The  Pan  MPU  uses  23  of  its  24  output  pins  to  represent  the  five  digits,  a  minus 
sign  and  a  decimal  point.  Each  of  the  five  digits  is  available  in  BCD  form  on  four  output 
pins  of  the  MPU.  The  five  digits  are  referred  to  as  Digit  1,  Digit  2,  etc.,  with  Digit  1 
being  the  least  significant  digit  and  Digit  5  being  the  most  significant  digit.  Port  A  has 
as  its  output  the  BCD  representation  of  Digit  3  and  Digit  4.  Digit  1  and  Digit  2  are 
represented  by  the  output  of  Port  C.  The  low  four  bits  of  Port  B  contain  the  BCD 
representation  of  Digit  5.  These  20  output  lines  are  the  input  to  five  74LS47, 
BCD/7-Segment  Decoder/Drivers,  which  decode  the  BCD  signals  and  drive  the  common 
anode  LED  indicators.  The  output  from  Pin  29,  PB4,  is  one  input  to  a  74LS32  OR  gate, 
the  output  of  which  is  used  to  blank  leading  zeros  out  of  the  display.  Pin  30  is  not  used 
and  is  tied  to  ground.  The  remaining  two  output  pins  drive  two  LED  segments  in  the 
display.  The  signal  on  pin  31  turns  the  minus  sign  off  and  on,  and  the  signal  on  pin  32 
determines  whether  the  decimal  point  is  displayed. 

The  electrical  characteristics  of  the  I  O  Ports  are  given  on  p.  4  of  Ref.  10.  The 
output  characteristics  of  Ports  A,  B  and  C  are  compatible  with  the  input  characteristics 
of  the  74LS47  and  the  74LS32  given  on  pp.  4-59  and  4-48  of  Ref.  11.  The  pins  on 
Port  B  are  capable  of  sinking  10  mA  when  Port  B  is  configured  as  an  output  port.  A 
220  Q  resistor  placed  in  series  with  each  of  the  display  segments  limits  the  current  to 
approximately  9  mA  and  permits  the  MPU  to  drive  the  decimal  point  and  minus  sign 
directly. 

One  consideration  in  the  design  of  this  system  was  to  provide  a  system  capable 
of  being  readily  expanded  to  meet  changing  needs.  To  this  end,  in  addition  to  being 
connected  to  the  LED  display  devices  via  the  74LS47's,  the  BCD  data  lines  are  also 
connected  to  a  header  on  each  of  the  MPU  circuit  boards.  If,  at  a  later  date,  the  posi- 
tion information  needs  to  be  used  in  another  system,  a  jumper  connected  to  each  of  the 
headers  could  provide  the  information  with  little  or  no  modification. 

The  Pan  and  Tilt  signal  processing  subsystems  are  virtually  identical  in  the 
hardware  used  to  implement  them.  The  only  difference  is  that  the  Pan  system  has  a  five 
digit  display,  and  the  Tilt  system  needs  only  four  digits  to  display  its  position  informa- 
tion. Consequently,  the  Tilt  system  does  not  use  Digit  5,  and  pins  25-29  are  tied  to 
ground. 
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F.  DISPLAY 

Each  digit  represented  in  BCD  at  the  output  of  the  MPU  is  decoded  by  a  74LS47 
BCD'7-Segment  Decoder/Driver.  The  decoding  devices  each  convert  a  four  bit  BCD 
representation  of  a  number  into  seven  signals  that  each  drive  a  separate  segment  of  a 
common  anode,  seven  segment,  LED  display.  The  74LS47  is  capable  of  sinking  24  mA 
from  each  of  the  LED  segments.  Without  a  current  limiting  resistor  between  each  of  the 
output  pins  on  the  7447  and  the  corresponding  pin  on  the  display  element  however,  this 
maximum  current  is  exceeded.  When  this  happens  the  LED's  have  a  very  short  life,  the 
7447  overheats  and  the  system  fails  to  function  properly.  The  addition  of  a  220  Q.  re- 
sistor in  each  branch  limits  the  current  to  about  9  mA  per  segment,  and  permits 
trouble-free  operation. 

Three  of  the  output  pins  on  each  MPU  are  not  used  as  inputs  to  the  7447's.  As 
discussed  in  the  previous  section,  the  Decimal  and  Minus  lines  each  drive  individual 
LED  segments  directly.  The  third  line,  also  mentioned  briefly  in  the  preceding  section, 
is  used  with  the  Blanking  In; Ribbon  Blanking  Out  (BI/RBO)  signal  from  Digit  4's  7447 
to  determine  the  Ribbon  Blanking  In  (RBI)  signal  into  the  7447  which  drives  the  display 
for  Digit  3. 

The  term  "blanking"  simply  means  removing  the  leading  zeros  from  the  display. 
The  two  display  modes  available  from  the  MPU's  have  different  blanking  requirements. 
In  the  Position  Mode  the  three  least  significant  digits  are  not  blanked,  while  in  the 
Count  Mode,  all  but  the  least  significant  digit  are  blanked.  The  RBI  and  BI/RBO  pins 
on  the  7447's,  the  Blank  line  out  of  each  MPU  and  the  OR  gates,  connected  as  shown 
in  the  schematics  in  Appendix  A,  provide  this  capability. 

The  Light  Test  (LT)  pin  on  each  7447  is  connected  to  SW5.  When  the  switch  is 
closed,  the  Light  Test  line  goes  low  and  each  of  the  output  lines  on  each  of  the  7447's 
also  goes  low,  thus  sinking  current  from  all  of  the  LED  segments  simultaneously.  This 
feature  allows  the  operator  to  check  for  inoperable  display  segments. 

G.  POWER  SUPPLIES 

The  two  power  supplies  shown  in  Figure  2  on  page  6  are  each  +  5.0  Vdc  supplies. 
The  power  supply  which  provides  power  to  the  shaft  encoders  and  the  line  drivers  is 
physically  mounted  in  the  camera  housing.  It  was  built  by  modifying  the  +  12  Vdc  auto 
iris  power  supply.  This  was  accomplished  using  an  LM7805  Voltage  Regulator  in  the 
manner  shown  in  Figure  8  of  Appendix  A.  The  auto  iris  requires  only  100  mA  at 
+  12  Vdc  for  correct  operation,  and  the  LM7812  Voltage  Regulator  has  an  available 
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output  current  of  1.0  A  [Refs.  15,  16].  The  remaining  900  mA  is  available  to  the 
LM7805  to  power  the  encoders  and  the  line  drivers.  Reference  9  lists  the  maximum 
power  requirement  for  the  IIEDS-600  as  40  mA  at  +5  Vdc,  and  Ref.  11  specifies  the 
maximum  power  requirement  for  a  74S140  is  1  mA  at  +  5  Vdc.  Thus,  the  84  mA  re- 
quirement for  the  two  encoders  and  four  line  drivers  is  well  within  the  capabilities  of  the 
modified  power  supply. 

The  second  power  supply  is  capable  of  providing  6.0  A  at  +  5  Vdc  which  is  more 
than  adequate  to  provide  the  1.4  A  needed  by  the  signal  processors  and  the  display  de- 
vices. The  power  supply  also  has  12  Vdc  and -5  Vdc  ports.  To  preclude  the  potentially 
disastrous  results  which  might  occur  if  the  power  supply  were  incorrectly  connected  to 
the  signal  processor/display  devices,  the  circuitry  shown  in  Figure  21  was  included  on 
each  MPU  and  display  printed  circuit  board. 
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Figure  21.      Reverse/Over- voltage  Protection  Circuit 
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IV.     CALIBRATION  ,  TESTING  AND  IMPLEMENTATION 

A.  GENERAL 

Once  the  basic  system  design  had  been  completed,  and  the  MPU  programs  had  been 
written,  a  prototype  system  was  constructed.  The  prototype  system  might  also  be  called 
the  development  model,  since  it  was  not  only  used  to  test  the  design  ,  but  was  also  used 
to  calibrate  the  MPU  programs.  A  block  diagram  of  the  prototype  system  is  shown  in 
Figure  22.  The  M68705EVM  Evaluation  Module  (subsequently  referred  to  as  the 
EVM)  provided  the  capability  to  debug  and  evaluate  the  MC68705U3-based  signal 
processing  subsystem.  Operation  of  the  signal  processing  MPU  was  performed  by  an 
MC68705U3  resident  on  the  EVM. 

The  prototype  system  provided  considerable  flexibility  in  the  testing  and  calibration 
of  the  system.  The  assembly  language  programs  for  the  MPU's  were  written  and  edited 
on  the  PC.  They  were  then  assembled  and  linked  using  the  2500  A.D.  6805  Cross  As- 
sembler and  2500  A.D.  Linker  [Ref.  17:  pp.  (l-l)-(2-38)j.  The  result,  a  Motorola  S19 
output  file  (see  [Ref.  17:  pp.  (A-l)-(A-4)]),  was  then  down-loaded  to  the  EVM  using  the 
file  transfer  program,  Kermit.  Downloading  procedures  are  detailed  in  [Ref.  18:  pp. 
(3-10)-(3-25),(3-37)].   The  PC-EVM  interface  is  shown  in  Figure  23. 

After  the  program  had  been  down-loaded  into  the  MC68705U3  resident  on  the 
EVM,  data  entry  and  program  debugging  were  controlled  via  the  CRT  monitor  key- 
board. The  CRT-EVM  interconnection  is  shown  in  Figure  24  and  the  monitor  com- 
mands are  described  in  [Ref.  18:  pp.  (3-8)-(3-25)]. 

The  remainder  of  the  signal  processing  functions  were  realized  using  hardware  ex- 
ternal to  the  EVM.  These  functions  included  edge  detection  of  the  output  signals  from 
the  shaft  encoders,  decoding  the  output  of  the  MPU,  and  generating  the  signals  to  drive 
the  display  devices.  This  portion  of  the  prototype,  referred  to  by  [Ref.  18]  as  the  "target 
system",  was  built  on  breadboards  and  is  represented  by  the  block  in  the  center  of 
Figure  22.  The  target  system  was  connected  to  the  MCU  via  a  40-pin  jumper  header, 
Jl,  on  the  EVM.  The  pinout  for  Jl  is  shown  in  Figure  25.  The  labels  in  Figure  25  refer 
to  the  labels  used  in  the  schematic  diagrams  which  are  shown  in  Appendix  A. 

B.  CALIBRATION 

Once  the  MPU  programs  were  capable  of  counting  the  pulses  generated  by  the  shaft 
encoders,  the  programs  needed  to  be  "calibrated".    This  calibration  procedure  required 


48 


Figure  22.      Prototype/Development  Model 
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Figure  23.      Host  Computer  -  Evaluation  Module   Connections 
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Figure  25.      Evaluation  Module  -  Signal  Processor  Connections 
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determining  the  angular  distance  through  which  the  camera  rotated  between  successive 
pulses  from  the  shaft  encoder.  This  number  is  a  scale  factor,  which,  when  multiplied  by 
the  total  number  of  pulses  from  the  shaft  encoder,  yields  a  number  equal  to  the  angular 
displacement  of  the  camera.  The  calibration  procedure  also  involved  determining  the 
amount  of  hysteresis  present  in  each  of  the  gear  trains. 
1.     Scale  Factor 

To  determine  the  scale  factor  (SF)  the  simple  geometric  relationship 

„„„*->(  msOL)  (12) 

V   adjacent  J 

was  used.  Using  a  small  laser  attached  to  the  camera  servo,  and  the  geometry  shown  in 
Figure  26,  the  SF  could  be  experimentally  determined.  As  the  camera  servo  was  rotated 
through  an  angle,  8,  the  MPU  was  used  to  count  the  output  pulses  from  the  shaft  en- 
coder. The  laser  beam  was  projected  on  a  vertical  surface  at  a  distance,  a,  away  from 
the  axis  of  rotation.  The  beam  of  the  laser  spread  to  a  diameter  of  approximately  0.4 
in.  over  a  distance  of  30  ft.  A  template  with  a  0.4  in.  diameter  aperture  was  used  to  mark 
the  location  of  the  "spots"  on  the  distant  wall.  The  distance  between  the  spots,  /,  was 
measured  by  selecting  one  edge  of  one  of  the  marks  and  measuring  the  distance  to  the 
corresponding  edge  of  the  distant  mark.  Then,  having  determined  /  and  a  and  reading 
the  count,  C,  from  the  display,  the  SF  could  then  be  determined  from 


n 

SF( degrees  Pulse)  =  — 


11™L)  (13) 


tan 

a(in 


Using  Equation  (13)  to  simplify  the  expression, 


<5(SF)  S(S¥) 

d(SF)  =  -^  d/  +  -ij-^  da  (14) 

ol  da 


yields 
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Figure  26.      Geometry  Used  to  Determine  the  Scale  Factor 
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(15) 


which  indicates  that  C,  a  and  /  should  all  be  as  large  as  possible  to  minimize  the  error 
in  SF  due  to  a  measurement  error  in  a  or  /.  The  physical  size  of  the  laboratory  limited 
the  distance,  a  ,  to  30  ft.    When  a  =  30  ft,  /  was  limited  to  about  3.5  ft  in  the  horizontal 
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plane  and  about  4.0  ft  in  the  vertical  plane.  By  modifying  the  geometry  as  shown  in 
Figure  27,  the  count,  which  from  Equation  (13)  is  directly  proportional  to  0,  could  also 
be  maximized.  The  configuration  shown  in  Figure  27  was  used  to  obtain  the  scale  fac- 
tor calibration  data  for  the  Pan  axis.  However,  since  the  servo  is  incapable  of  rotating 
360°  about  the  Tilt  axis,  the  test  configuration  shown  in  Figure  26  had  to  be  used  the 
collect  the  data  for  that  axis. 


Figure  27.      Alternate  Geometry  Used  to  Determine  the  Scale  Factor 

Adopting  the  notation,  X,  to  represent  the  mean  value  of  a  random  variable, 
X;  if  X  is  discrete  with  N  measured  values, 


N 


(16) 
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where  X,  is  the  /th  measured  value  of  X,  and  the  approximation  becomes  better  as  N 
approaches  infinity. 

Using  the  expression  in  Equation  (16)  and  the  measured  data  for  the  scale  fac- 
tors, from  31  measurements  on  the  Pan  axis, 

SFPan  =  (7.0312  x  10"3)°Pulse_1  ,  (17) 

and  after  32  measurements  on  the  Tilt  axis, 

SFTllt  =  (7.0452  x  10"3)°Pulse_1  ,  (18) 

where  the  subscripts  indicate  the  axis.  The  actual  implementation  of  these  scale  factors 
is  described  later  in  this  chapter  and  in  the  documentation  for  each  of  the  MPU  pro- 
grams. 

If  the  error  in  the  /th  measurement  is  described  by 

e,  =  A',.-X,  (19) 

then  the  root  mean  square  (RMS)  error  in  N  measurements  of  X  is  given  by; 


=  N/^Z(Xi~X)2    •  <20) 


Note  that  this  is  also  the  definition  of  the  standard  deviation  of  X. 

The  RMS  errors  in  the  Pan  and  Tilt  scale  factor  measurements  were  determined 
from  Equation  (20)  and  the  measured  data  to  be; 

aSFpan  =  (4.62  x  KrVPulse"1  (21) 

aSFTiit  =  (6.89xl0-6)°Pulse-1   .  (22) 

As  before,  the  subscripts  are  used  to  identify  the  axis  and  the  source  of  the  error.    The 
fact  that  the  errors  are  small  compared  to  the  mean  values  suggests  that  the  means 
should  closely  approximate  the  actual  values  for  the  scale  factors. 
2.     Hysteresis 

Houghton  defines  backlash  in  wormgearing  as  "...the  total  play  between  the 
surfaces  of  the  worm  and  worm  wheel  teeth  measured  normal  to  the  faces."  [Ref.  19: 
pp.  1.4.  1.5]  Backlash  only  poses  a  problem  in  the  measurement  system  when  the  servo's 
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direction  of  rotation  changes.  Figure  28  is  a  typical  hysteresis  curve.  As  long  as  the 
direction  of  rotation  of  the  worm  is  increasing  the  0WOrm/0wormgear  relationship  is  linear. 
However,  when  the  direction  of  rotation  reverses  there  is  a  region,  depicted  by  the  left 
pointing  arrows,  where  the  position  of  the  worm  changes  without  a  corresponding 
change  in  the  position  of  the  wormgcar.  Note  that  once  all  of  the  backlash  has  been 
taken  up  the  0Worm/0wormgear  relationship  is  again  linear  until  the  direction  of  rotation 
changes. 


Figure  28.      Typical  Hysteresis  Curve 

The  purpose  of  the  hysteresis  buffer  in  the  MPU  is  to  permit  the  signal 
processor  to  account  for  the  backlash  error  introduced  into  the  measurement  by  the 
worm-wormgear  connection.  The  theory  of  operation  for  the  buffer  is  relatively  straight 
forward  and  is  best  described  by  the  flow  diagram  in  Figure  29.  The  buffer  is  a  data 
byte  in  the  MPU  RAM.  As  long  as  the  buffer  is  full,  i.e.,  the  contents  are  equal  to  the 
predetermined  buffer  length,  a  clockwise  (CW)  signal  from  the  shaft  encoder  (increasing 
elevation  and  increasing  azimuth  are  defined  as  CW  rotation  for  the  purposes  of  this 
system)  causes  the  position  counter  to  be  incremented.     Similarly,  counter-clockwise 
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Figure  29.      Operation  of  the  Hysteresis  Buffer 
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Figure  30. 


Hysteresis  Curve 


(CCW)  signals  cause  the  position  counter  to  be  decremented  if  the  hysteresis  buffer  is 
empty,  i.e.,  the  contents  are  equal  to  zero.  These  two  situations  correspond  to  the  two 
linear  sections  in  Figure  28.  From  Equation  (13).  the  horizontal  separation  of  these  two 
lines  is  related  to  the  length  of  the  hysteresis  bufTer,  CH  by  the  expression 


CH  = 


SF 


(23) 


Similarly,  using  the  SF  to  map  0Worm  into  C,  and  the  fact  that  the  displacement  of  the 
wormgear  equals  the  displacement  of  the  axis  of  interest,  the  curve  shown  in  Figure  30 
can  be  obtained  from  Figure  28.  From  Figure  30  it  is  apparent  that  two  different  pulse 
counts  can  be  obtained  for  any  given  position,  0,  depending  on  whether  thai  position  is 
approached  from  a  CW  or  a  CCW  direction.  The  difference  in  the  two  counts  is  a 
measure  of  the  hysteresis  present  in  the  gear  train  and  is  also  the  required  length  for  the 
hysteresis  bufTer.  By  using  this  difference  as  the  length  of  the  hysteresis  bufTer,  counts 
received  by  the  MPU  which  occur  while  the  gears  are  operating  on  one  of  the  horizontal 
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sections  of  the  curve  in  Figure  30  are  not  considered  "valid"  and  therefore  do  not  cause 
the  MPU  to  modify  the  position.  Using  Equation  (23)  and  data  collected  in  the  labo- 
ratory the  average  hysteresis  present  in  each  of  the  gear  trains  was  determined  (from  45 
measurements  on  the  Pan  axis  and  30  measurements  on  the  Tilt  axis)  to  be 

CH(Pan)=  7.39  Pulses  (24) 

CH(Tih)  =  6.06  Pulses  (25) 

and  the  RMS  errors  were  calculated  to  be, 

or        =1.0  Pulses  (26) 

or        =0.91  Pulses  .  (27) 

C.     IMPLEMENTATION  OF  THE  CALIBRATION  DATA 

1.     Background 

Figure  31  outlines  the  basic  operation  of  each  of  the  MPU's.  Although  each 
of  the  routines  is  described  in  detail  by  the  comments  included  in  the  programs,  the  op- 
eration of  the  Count  Routine  is  the  heart  of  the  program  and  should  be  explained  prior 
to  discussing  the  actual  implementation  of  the  experimental  results. 

When  the  system  operator  causes  the  camera  servo  to  rotate,  each  optical  shaft 
encoder  translates  the  displacement  of  one  of  the  axes  into  two  series  of  digital  pulses. 
The  two  pulse  trains,  referred  to  as  Channels  A  and  B.  are  TTL  logic  level  signals.  When 
the  logic  level  of  Channel  A  transitions  from  low  to  high  (rising  edge  transition)  or  from 
high  to  low  (falling  edge  transition),  the  edge  detector  (See  Figure  15  on  page  33)  pulls 
pin  3  of  the  associated  MPU  low  for  approximately  2  ^sec.    When  this  occurs  an  ex- 


ternal interrupt  (EXT  INT  or  INT  )  request  is  generated  and  the  MPU  begins  execution 
of  the  Count  Routine. 

As  mentioned  in  Chapter  III,  since  both  rising  and  falling  edge  transitions  are 
detected  by  the  edge  detector,  the  signal  processor  must  be  capable  of  detecting  multiple 
oscillations  of  the  shaft  about  a  single  logic  level  transition  point.  Accordingly,  the  first 
tasks  performed  by  the  Count  Routine  are  to  determine  the  direction  of  rotation  and  to 
simultaneously  determine  whether  the  interrupt  is  the  result  of  a  stationary  shaft  oscil- 
lation. To  do  this  the  Count  Routine  checks  the  state  of  pin  17  (Channel  A)  and  pin 
19  (Channel  B).    Operation  of  this  portion  of  the  routine  is  summarized  in  Table  5. 
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Figure  31.  Program  Flow  Diagram:  Program  executes  in  the  Wait  Loop  until;  (a) 
the  operator  requests  to  modify  the  hysteresis  buffer,  (b)  the  operator 
requests  to  change  the  display  mode,  (c)  an  external  interrupt  is  gener- 
ated by  the  Channel  A  edge  detector  or,  (d)  a  timer  interrupt  causes  the 
display  mode  to  "blink".  All  interrupt  routines  are  terminated  with  a 
return  from  interrupt  (RTI)  command. 
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Note  that  CW  rotation  is  indicated  when  Channel  B  leads  Channel  A  in  phase  and  CCW 
rotation  is  indicated  if  Channel  A  is  leading  Channel  B.  The  possibility  of  erroneously 
counting  multiple  oscillations  about  a  single  point  is  eliminated  by  "counting"  only  the 
leading  edge  transitions  when  the  shaft  is  rotating  CW  and  only  the  trailing  edge  tran- 
sitions when  the  rotation  is  CCW.  All  other  transitions  cause  the  program  to  execute 
a  "return  from  interrupt"  (RTI)  instruction. 
2.     Implementing  the  Hysteresis  Buffer 

The  transitions  that  are  to  be  counted  cause  the  program  to  compare  the  con- 
tents of  the  hysteresis  buffer,  HYSTCT,  and  the  direction  of  rotation  to  the  exper- 
imentally determined  buffer  length,  HYST=CH  .  If  the  rotation  is  CW  and  the  buffer  is 
full  (i.e.,  HYSTCT  =  HYST),  or  if  the  rotation  is  CCW  and  the  buffer  is  empty  (i.e., 
HYSTCT=0),  then  the  "slack"  due  to  the  gear  backlash  should  have  been  taken  up  , 
the  transitions  are  considered  "valid"  and  the  MPU  modifies  the  position  appropriately. 
"Invalid"  counts  cause  the  contents  of  the  hysteresis  buffer  to  be  incremented  or  decre- 
mented depending  on  whether  the  present  direction  of  rotation  is  CW  or  CCW 
(Figure  29  refers). 

Table  5.     COUNT  ROUTINE  LOGIC 


Channel  A 

Channel  B 

Direction 
of  Rotation 

Count  the 
Pulse? 

Action 

Low 

Low 

CW 

No 

Increment  the 
hysteresis  buffer. 

Low 

High 

CCW 

Yes 

Decrement 
the  position. 

High 

Low 

CCW 

No 

Decrement  the 
hysteresis  buffer. 

High 

High 

CW 

Yes 

Increment 
the  position. 

From  the  calibration  data  for  the  Pan  axis,  CH,P,n^7.4  and  a<-  „_  =1.0.  Because 
the  length  of  the  hysteresis  buffer  must  be  an  integer  value,  CH(Pini.  needed  to  be  rounded 
off.  Rounding  to  the  nearest  whole  number  initially  seemed  the  most  logical  approach. 
Upon  further  consideration,  however,  it  was  decided  to  round  7.4  up  to  8.  Considering 
the  relatively  small  data  base  (45  measurements)  upon  which  the  average  was  based,  the 
fact  that  the  standard  deviation  was  1.0  and  that  the  cear  backlash  will  onlv  increase 
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with  time,  this  seemed  like  the  most  reasonable  approach.  The  buffer  length  for  the  Tilt 
axis  was  set  equal  to  6  (CH,Tm)  =  6.06)  . 
3.     Implementing  the  Scale  Factor 

There  are  three  counters  in  each  MPU  that  keep  track  of  the  position  informa- 
tion for  the  axis  of  interest.  The  first,  BINCT,  is  simply  a  binary  counter  that  is  incre- 
mented by  one  for  each  valid  CW  count  and  decremented  by  one  for  each  valid  CCW 
count.  The  other  two  counters  consist  of  two  sets  of  pointers,  two  sets  of  data  registers 
and  a  shared  data  table.  Each  byte  in  a  pointer  points  to  an  address  in  the  table  that 
contains  two  BCD  digits  which  make  up  a  portion  of  the  position  information. 

In  order  to  increment  (decrement)  the  pulse  count,  BCDCT,  by  one,  the  count 
pointer,  CTPTR,  is  incremented  (decremented)  by  one  causing  it  to  point  to  a  new  table 
address.  The  contents  of  the  table  at  the  new  addresses  are  then  moved  into  BCDCT. 
Modification  of  the  position  counter,  DEGRES,  is  performed  in  much  the  same  manner. 
DEC  RES  contains  a  BCD  number  that,  when  multiplied  by  0.001,  represents  the  angu- 
lar position  (in  degrees)  of  the  shaft  of  interest.  Thus,  each  time  the  camera  is  displaced 
in  a  CW  direction  through  one  degree,  the  contents  of  DEGRES  should  be  incremented 
by  1000.  To  do  this,  the  position  pointer,  PTR,  must  be  incremented  (decremented)  by 
seven  or  eight  each  time  CTPTR  is  incremented  (decremented)  by  one.  Incrementing 
PTR  by  seven  corresponds  to  an  angular  displacement  of  0.007°  and  since 
SFPan  and  SFTlll  are  each  slightly  larger  than  0.007°,  periodically  PTR  must  be  incre- 
mented by  eight  to  reduce  the  cumulative  round  off  error.  Specifically,  if  PTR  is  incre- 
mented by  seven  each  time  a  valid  CW  pulse  is  detected  (except  when  BINCT  is  an  even 
multiple  of  32)  and  is  incremented  by  eight  when  BINCT  is  a  modulo  32  number,  the 
effective  scale  factor  is  given  by; 


(28) 


SFe//i  =  -jy  (31(0.007)  +  0.008) 


=  0.00703 125°Pulse_1  , 

which  is  slightly  larger  than  the  desired  0.00703 12°Pulse-',  for  the  Pan  axis  and  slightly 
smaller  than  the  desired  0.0070452°Pulse-1  for  the  Tilt  axis.  To  further  reduce  the  cu- 
mulative round  off  on  the  Pan  axis,  even.'  16,384  (2'"  =  32  x  512)  counts  PTR  is  incre- 
mented bv  seven  instead  of  eieht.   This  results  in  an  effective  scale  factor  of, 
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SF,//2  =  Tjy{51l[1L(31(7)  +  8)xlO-3]  +  0.007}  ^ 

=  (7.031 19  x  10~3)°Pulse_I  , 

which  is  within  two  parts  in  one  million. 

The  maximum  error  introduced  into  the  measurement  should  occur  when  the 
camera  is  rotated  through  the  largest  possible  angle.  To  predict  this  error  on  the  Pan 
axis,  when  the  camera  has  been  displaced  by  360°, 

BCDCT  =  J^-°° 


SFPan  (30) 

=  51,200  Pulses 


so  the  position  error  using  SF,^  and  SFe//2   should  be; 

ePan  =  360°  -  [3(SFe//2)  +  (51,200  -  3(16,384))(S<?//])] 
=  0.00295°  . 


(31) 


Thus,  the  error  due  to  the  scale  factor  on  the  Pan  axis  should  be  well  within  the  desired 
resolution  of  ±0.006°  . 

Using  SF(     alone  as  the  scale  factor  for  the  Tilt  axis,  the  maximum  theoretical 
error  over  ±12°  due  to  the  scale  factor  round  off  is  determined  in  the  same  manner. 

P° 
BCDCT  =  _ 

SFTat  (32) 

=  17,033  Pulses 

So  that, 

em=12°-17,033(SFe//i) 

=  0.0234°  ,  (     ' 

which  again  is  significantly  less  than  the  required  resolution  of  ±0.23°  for  the  Tilt  axis. 
The  final  step  in  the  Count  Routine  is  a  branch  to  the  Display  Routine.    De- 
pending on  whether  the  MPU  is  in  the  Count  or  Position  Mode,  the  Display  Routine 
copies  the  contents  of  BCDCT  or  DEGRES  to  the  output  ports  and  then  executes  an 
RTI  instruction. 
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D.     FINAL  TESTING 
1.     General 

Final  laboratory  testing  and  evaluation  of  the  measurement  system  was  per- 
formed after  the  calibration  results  had  been  implemented  in  each  of  the  MPU  Count 
Routines.  The  purpose  of  the  testing  was  to  verify  that  the  calibration  results  had  been 
properly  coded  into  the  MPU's  and  to  determine  the  resolution  capabilities  of  the 
measurement  system  experimentally. 

This  verification  process  included  determining  the  combined  error  due  to  the 
hysteresis  and  scale  factor  errors.  The  use  of  some  simple  multiple  random  variable 
theory  was  therefore  required.  From  [Ref.  20:  pp.  121,122]  the  variance  of  a  weighted 
sum  of  M  random  variables  is  the  weighted  sum  of  their  covariances,  C*  ~ ,  and  is  given 

by, 

M      M 

where  a,  is  the  weight  associated  with  X,.  Additionally,  the  covariance  can  be  expressed 
as 

CXY  =  P°XaY   .  (35) 

where  p  is  the  normalized  second-order  moment  and  is  known  as  the  correlation  coeffi- 
cient of  X  and  Y.   The  correlation  coefficient  is  bounded  by 

-1  <  p  <   1   .  (36) 

In  the  case  where  there  are  two  equally  weighted  random  variables,  M  =  2  and 
a,  =  olj  =  1.0.   Substituting  into  Equation  (34)  and  expanding 

<?2  =  CXX  +  CXY  +  CYX  +  CYY    •  (37) 


Using  Equation  (35), 


2  2  2 

O     =  <7X  +  2pOXOy  +  Oy     .  (38) 


Combining  (36)  and  (38)  yields 


2  111  0 

ox  —  2oxoY  +  aY  <  a   <  ax  +  2oxOy  +  oY  .  (39) 
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The  bounds  of  the  combined  scale  factor  and  hysteresis  errors  can  therefore  be  deter- 
mined from 


V  °\r  ~  2c^GeH  +  <4    *  a'^  \  °If  +  2°^°eH  +  °lH     ■  (40) 

where: 

•  a,  =  standard  deviation  of  the  combined  error, 

•  a,SF  =  standard  deviation  of  the  scale  factor  error,  and 

•  o    =  standard  deviation  of  the  hysteresis  error. 

Note  that  the  bounds  are  determined  by  the  two  cases  where  the  hysteresis  error,  eH,  and 
the  scale  factor  error,  eSF,  are  "completely  correlated".  The  upper  bound  corresponds 
to  the  case  where  an  increase  in  eSF  implies  an  increase  in  eH,  and  the  lower  bound  cor- 
responds to  the  case  where  an  increase  in  eSF  directly  implies  a  decrease  in  eH. 

A  third  case  is  also  of  particular  interest.    If  eH  and  eSF  are  completely  uncor- 
rected, i.e..  p  =  0,  then  from  Equation  (38), 


^  =  V4f  +  ^    '  <41) 


which  can  also  be  written  as 


««±V«sf  +  «h    ,  (42) 


where  e  =  +  a,  is  the  1.0  a  error  due  to  the  scale  factor  and  hysteresis  errors,  eSF  and  eH 
respectively.  Based  on  the  physical  nature  of  the  two  errors  it  is  reasonable  to  assume 
that  eSF  and  eH  are  statistically  uncorrected;  however,  no  experimental  data  was  collected 
to  support  this  hypothesis.  Due  to  this  lack  of  a  priori  information,  the  maximum  RMS 
error.  emax  =  +  a.     .  given  bv 

max  —       'nu,     c 


emax  =  ±  \  esV  +  2eSFeH  +  e-H    ,  (43) 

will  be  used  to  describe  the  resolution  capabilities  of  the  measurement  system. 
2.     Pan  Aajs 

a.     Hysteresis 

To  test  the  operation  of  the  Pan  axis  hysteresis  buffer,  the  Initialization 
Routine  was  programmed  to  set  the  buffer  length  to  8.  Then,  as  described  in  the  first 
section  of  this  chapter,  the  servo  was  used  to  position  the  beam  of  a  small  laser  on  a 
fixed  target.   By  approaching  the  target  alternately  from  a  C\V  and  a  CCW  direction  and 
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comparing  the  difference  in  the  output  counts  from  the  shaft  encoders,  the  hysteresis 
error  was  determined.   The  average  error  after  31  measurements  was 

eH(Pan)  =  -0.1880  Pulses  ,  (44) 


and  the  RMS  error  was 


ae        =1.7699  Pulses  .  (45) 

eH(Pin)  v        ' 


Since  the  mean  error  is  "near  zero"  compared  to  the  standard  deviation,  the  1.0  a  error 
eH,  due  to  the  hysteresis  can  be  determined  from 


eH  =  ±  (OSF  (46) 


so  that 


eH(Pan)  =  ±  0-0124°  .  (47) 


b.     Scale  Factor 

Verification  of  the  scale  factor  was  performed  in  the  same  manner  as  the 
scale  factor  calibration,  except  that  the  MPU  was  calibrated  in  the  Count  Mode  and 
tested  in  the  Position  Mode.  Since  these  tests  sought  to  find  the  maximum  error  due  to 
the  scale  factor,  and  the  error  is  directly  proportional  to  the  angle  that  is  being  meas- 
ured, these  tests  were  conducted  by  displacing  the  camera  servo  through  the  maximum 
angles  permitted  by  the  camera  and  the  laboratory.  Specifically,  on  the  Pan  axis  the 
servo  was  rotated  through  approximately  360°.  The  mean  error  due  to  the  scale  factor 
on  the  Pan  axis  was  determined  from  15  samples  to  be 

eSF(Pan)  =  -0.0018°  (48) 

and  the  RMS  error  was 

ae         =0.00890°  .  (49) 

As  with  the  hysteresis  error,  if  we  neglect  the  small  bias  due  to  the  eSHPtn)  ,  we  can  de- 
scribe the  1.0  a  RMS  error  due  to  the  scale  factor  as 

eSF(Pan)  =  ±  ^SF(Pan)  s 

=  -f0.00S90°  '  l     ' 
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c.     Combined  Error 

From  Equation  (42)  the  combined  error  on  the  Pan  axis  if  eH  and  eSF  are 

uncorrelated  can  be  estimated  as 


epan  =  ±\/(0-0124)2  +  (0.0089)2  (51) 

=  ±0.01526°  . 

And  from  Equation  (43)  the  maximum  combined  error  on  the  Pan  axis  is 


epanmax  =  ±  \l  (0.0 124)2  +  2(0.0 124)(0.0089)  +  (0.0089)2  (52) 


ePanm    =±0.0213°  .  (53) 


'max 


The  combined  error  is  approximately  three  times  larger  than  the  design  specification 
limit  and  is  due  primarily  to  the  hysteresis  error. 
3.     Tilt  Axis 

a.  Hysteresis 

The  procedure  used  to  verify  the  operation  of  the  calibrated  Tilt  MPU  was 
identical  to  that  described  in  the  previous  section.  Using  a  hysteresis  buffer  length  of  6 
resulted  in 

eH(Tlll)  =  -0.0965  Pulses  (54) 

and, 

ae        =  1.3156  Pulses  (55) 

eH(Tm>  v      ' 

after  13  samples.   As  before  we  can  define  the  1.0  a  error  from  e  =  aSF  to  be 

eHTm  =  ±  0.00529°  .  (56) 

b.  Scale  Factor 

Testing  the  scale  factor  on  the  Tilt  axis  was  limited  by  the  physical  con- 
struction of  the  servo  and  the  size  of  the  laboratory.  The  angle  over  which  testing  could 
be  performed  was  limited  to  ±6°  from  the  horizontal  plane.  Consequently,  the  RMS 
error  for  the  scale  factor  on  the  Tilt  axis  was  determined  in  exactlv  the  same  manner  as 
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the  RMS  error  for  the  Pan  axis  scale  factor,  but  since  the  error  due  to  rounding  of  the 
scale  factor  is  directly  proportional  to  the  angle  being  measured  the  results  were  multi- 
plied by  2.0  to  account  for  the  limited  range  of  the  test.  The  modified  results  should 
therefore  be  representative  of  the  maximum  error  one  should  expect  if  the  measurement 
system  is  used  to  measure  elevation  angles  over  a  range  of  ±  12°  . 

The  error  due  to  the  scale  factor  is  described  from  16  samples  by 

esFcriit)-5  0.0070°  (57) 

and, 

oe         =0.0665°  .  (58) 

eSF(T.lt)  v        ' 

Including  the  factor  of  two  in  the  calculation  we  have 


esFcnit)  =  ±  2(0.0665°) 
=  +  0.1330°  . 


(59) 


c.     Combined  Error 

The  combined  RMS  error  is  determined  in  the  same  manner  as  before.    If 
eH  and  eSF  are  uncorrelated, 


e-nu  =  ±  x/(0.1330)2  +  (0.00529)* 
=  0.1331°  , 


(60) 


and  the  maximum  combined  RMS  error  is 


&nit  ax  =  ±\/(0-1330)2  +  2(0.1330)(0.00529) +  (0.00529)2  (61) 


eTlll     =±0.1383°  .  (62) 


The  Tilt  axis  measurement  system  appears  to  perform  well  within  the  required  resolution 
specifications. 
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E.     FINAL  IMPLEMENTATION 

Once  the  program  debugging,  calibration  and  testing  were  completed,  final  imple- 
mentation of  the  system  remained.  Taking  the  design  from  the  prototype  development 
model  to  a  fully  functional  system  was  a  straightforward  but  time-consuming  evolution. 

The  plans  for  the  printed  circuit  boards  (PCB's)  were  made  directly  from  the  sche- 
matics shown  in  Appendix  A;  the  boards  were  then  etched  and  assembled  from  the  plans 
which  are  shown  in  Appendix  B.  All  of  this  work  was  performed  by  sailors  attached  to 
the  Academic  Division  of  the  NPS. 

As  previously  discussed,  the  M68705EVM  Evaluation  Module  provided  a  powerful 
and  flexible  means  of  debugging  and  evaluating  the  performance  of  the  microprocessor 
based  signal  conditioner.  Additionally,  once  program  testing  was  completed  the  EVM's 
EPROM  microprocessor  programmer  provided  the  means  to  program  the  EPROM 
MCU's.  A  detailed,  but  simple  to  follow,  programming  procedure  for  programming  the 
MC6S705U3  is  given  in  [Ref.  18:  pp.  (3-26)-(3-27)]. 
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V.     CONCLUSIONS  AND  RECOMMENDATIONS 

A.  SYSTEM  PERFORMANCE 

The  prototype  system  was  calibrated  and  successfully  tested  in  a  laboratory  environ- 
ment. Experimental  results  indicate  that  the  system  is  capable  of  measuring  the  video 
camera's  elevation  over  a  range  of  ±12°  with  a  resolution  of  ±0.138°  and  its  azimuth 
over  360°  with  a  resolution  of  ±0.021°.  The  system  was  designed  to  be  low  cost,  reliable, 
and  easy  to  operate.   Only  time  will  tell  whether  these  objectives  were  truly  achieved. 

The  portion  of  the  system  that  will  be  located  outdoors  has  been  weatherproofed 
and  is  ready  to  be  placed  in  service.  Printed  circuit  board  plans  for  the  remainder  of  the 
system  have  been  developed,  but  final  implementation  of  the  system  is  still  ongoing. 
Once  the  system  is  fully  operation  additional  testing  should  be  performed  in  order  to 
verify  the  completed  system's  performance.  Although  the  laboratory  results  indicate 
that  the  system  is  capable  of  meeting  all  of  the  design  criteria  except  for  the  required 
resolution  on  the  Pan  axis,  the  system  must  be  further  tested  in  a  non-laboratory  envi- 
ronment. "...The  proof  of  a  good  design  rests  in  the  ability  of  the  system  to  function  in 
the  outside  world."   [Ref  21] 

B.  RECOMMENDATIONS  FOR  FURTHER  WORK 

There  are  several  areas  for  follow-on  work  with  this  project.   Some  possibilities  are: 

•  Incorporate  the  measurement  system's  output  into  the  video  image  being  created 
by  the  video  camera.  This  would  permit  a  permanent  record  of  the  position  infor- 
mation to  be  stored  with  the  video  image  and  would  facilitate  identification  of  the 
image  at  a  later  date. 

•  Design  and  build  an  automatic  feedback  control  system  for  the  camera. 

•  Implementation  of  a  second  video  camera  at  the  NPS,  together  with  the  NPS 
modified  IRSTD,  would  permit  triangulation  of  a  target  and  would  consequently 
provide  range  information  which  is  not  currently  available.  This  information  could 
provide  valuable  additional  information  to  those  who  are  developing  the  signal 
processing  algorithms. 
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APPENDIX  A.     SCHEMATIC  DIAGRAMS 
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APPENDIX  B.     PRINTED  CIRCUIT  BOARD  PLANS 
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Line  Driver,  (a)  Front  and  (b)  Back.    Full  scale. 
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Tan  MPU,  Front.   90  %  of  full  scale. 
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Pan  MPU,  Back.   90  %  of  full  scale. 


82 


r 


-t- 


V) 


o 

3 

e 

3 

to 

o 
* 

3 
3 


■       « 


-f 


_L 


Tilt  MPU,  Front.   85  %  of  full  scale. 
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Tilt  MTU,  Back.   85  %  of  full  scale. 
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Display,  Front.   Full  scale. 
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Display,  Back.   Full  scale. 
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APPENDIX  C.     MICROPROCESSOR  PROGRAMS 

A.     GENERAL 

Sections  B  and  C  of  this  Appendix  are  the  listing  files  for  the  two  MPU  programs 
written  for  the  signal  processor  subsystems.  The  theory  of  operation  of  the  two  pro- 
grams is  identical  and  is  most  clearly  described  by  Figure  31.  The  detailed  operation 
of  the  Initialization  ,  Mode  Change,  Blink,  Output  Display  and  Hysteresis  Modify'  rou- 
tines is  described  by  the  comments  which  accompany  each  of  the  programs.  In  addition 
to  the  detailed  description  provided  by  the  program  comments,  the  operation  of  the 
Count  Routine  is  also  explained  in  Chapter  IV. 
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PORTA 

EOU 

$0000 

I/O  PORT  A 

PORTS 

EOU 

$0001 

I/O  PORT  B 

PORTC 

EOU 

$0002 

I/O  PORT  C 

PORTD 

EOU 

$0003 

INPUT  PORT  D 

B.  PAN 


1  TTL  POSITION  DETERMINING  PROGRAM  (AZIMUTH) 

2  *  LATEST  REVISION  9  MAY  89 

3  *  FILE  NAME  PAN. ASM 

4  ** 

5  **  PROGRAM  DESCRIPTION 

6  •* 

7  ** 

8  *• 

9  "I/O  REGISTER  ADDRESSES 

10  ** 

11  0000 

12  0001 

13  0002 

14  0003 

15  ** 

16  *•  DATA  DIRECTION  REGISTER  OFFSET 

17  ** 

18  0004  DDR     EOU     4       (eg.  DDR  FOR  PORT  A  IS  PORTA+DDR  ) 

19  ** 

20  **  OTHERS 

21  ** 

22  0008  TIMER   EOU     $0008   EIGHT  BIT  TIMER  REGISTER. 

23  0009  TCR     EOU     $0009   TIMER  CONTROL  REGISTER. 

24  OOOA  MR      EOU     $0O0A   MISCELLANEOUS  REGISTER. 

25  0010  RAM     EOU     $0010   START  OF  ON-CHIP  RAM(112  -  31  FOR  STACK) 

26  0080  ZROM    EOU     $0080   PAGE  ZERO  OF  ROM. 

27  0100  ROM     EOU     $0100   START  OF  MAIN  ROM. 

28  0F38  MOR     EOU     $0F38   MASK  OPTION  REGISTER. 

29  0FF8  INTRPT  EOU     $0FF8   LOCATION  OF  INTERRUPT  VECTORS. 

30  1000  MEMS  I Z  EOU     $1000   MEMORY  ADDRESS  SIZE. 

31  ** 

32  "  EQUATES 

33  •* 

34  0001  BITO    EOU     1 

35  0002  BIT1    EOU     2 

36  0004  BIT2    EOU     4 

37  0008  BIT3    EOU     8 

38  0010  BIT4    EOU     16 

39  0020  BIT5    EOU     32 

40  0040  BIT6    EOU     64 

41  0080  BIT7    EOU     128 

42  ** 

43  0000  BO     EOU     0 

44  0001  B1      EOU     1 

45  0002  B2     EOU     2 

46  0003  B3     EOU     3 

47  0004  B4      EOU     4 

48  0005  B5     EOU     5 

49  0006  B6     EOU     6 

50  0007  B7     EOU     7 

51  ** 

52  "  EQUATES  FOR  THE  TIMER  CONTROL  REGISTER 
53 
54 

55  0007  TIR     EOU     7       TIMER  INTERRUPT  REOUEST.  1  =  REOUEST,  0  =  NO  RED. 

56  0006  TIM     EOU     6       TIMER  INTERRUPT  MASK.  1  =  DISABLED,  0  =  ENABLED. 

57  0005  TIN     EOU     5       EXTERNAL  OR  INTERNAL  CLOCK  SOURCE.  1  =  EXT,  0  =  INT 

58  0004  TEE     EOU     4       EXTERNAL  CLOCK  ENABLE.  NOT  USED. 

59  0003  PSC     EOU     3       PRESCALER  CLEAR.  NOT  USED. 

60  0002  PS2     EOU     2      (PS2)  -- 

61  0001  PS1     EOU     1       (PS1)    I--   PRESCALER  SELECT  BITS. 
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62 
63 

64 

65 

66 

67 

68 

69 

70 

71 

72 

73 

74 

75 

76 

77 

78 

79 

80 

81 

82 

83 

84 

85 

86 

87 

88 

89 

90 

91 

92 

93 

94 

95 

96 

97 

98 

99 

100 

101 

102 

103 

104 

105 

106 

107 

108 

109 

110 

111 

112 

113 

114 

115 

116 

117 

118 

119 

120 

121 

122 

123 

124 

125 

126 

127 


0000 


0007 
0006 
0005 
0004 
0003 
0002 


PSO     EQU     0      (PSO)  -- 

M 

**  EQUATES  FOR  THE  STATUS  BYTE,  'STAT' 

MM 


0007 
0006 

0004 


UD 

EQU 

7 

MOD  32 

EQU 

6 

FLASH 

EQU 

5 

POSCT 

EQU 

4 

L  SET 

EQU 

3 

NEGTIV 

EQU 

2 

**■* 

1 

»** 

0 

0007 
0006 
0005 
0004 


COUNT  DIRECTION?   1  =  UP,  0  =  DOWN. 

IS  'BINCT'  MODULO  32?   1  ■  YES,  0  ■  NO. 

BLINK  THE  DISPLAY?  1  *  YES,  0  ■  NO. 

DISPLAY  POSITION  OR  COUNT?  1  *  POS,  0  *  COUNT. 

VALUE  OF  »MODE,PORTD'  LAST  TIME. 

IS  'BCDCT'NEGATIVE  NUMBER?  1  =  YES,  0  ■  NO. 

NOT  USED. 

NOT  USED. 


**  I/O  EQUATES  AND  DESCRIPTIONS. 

*** 
*•* 

***  PORT  A  (I/O) 

*** 

***  + + + ♦ + + + + + 

***  |         BCD  DIGIT  #4         |         BCD  DIGIT  #3  | 

***  +... 4 4 + + 4 4 +  -. 4 

***  |   D4   |   C4   |   B4   |   A4   |   D3   |   C3   |   B3   |   A3   | 

***  4 4 4 4 4 4 4 4.. 4 

***  BIT      7      6      5      4      3      2      1       0 

*** 
*** 

***  PORT  B  (I/O) 

•** 

***  4- -4-- 4 4 4 4 4 4 4 

***  |        DISPLAY  CONTROL  •       |BCD  DIGIT  #5  (MOST  SIGNIFICANT)! 

***  4 4 4 4 4 4 4 4 4 

***  |  DECPT  |  POSTIV|       |  BLANK  |   D5   |   C5   |   B5   |   A5   | 

***  4-- 4 4 4 4 4 4 4 4 

***  BIT      7      6      5      4      3      2      1       0 

*•* 

DECPT  EQU     7       TO  DISPLAY  THE  DECIMAL  POINT. . .DECPT  IS  CLEARED 

POST IV  EQU     6       USED  TO  DISPLAY  NEGATIVE  SIGN. . .CLEARED  TO  SHOW 

***  MINUS  SIGN. 

BLANK  EQU     4       TO  BLANK  DIGITS  2  AND  3... CLEAR  BLANK. 

***  DIGITS  4  AND  5  ARE  ALWAYS  BLANKED. 

***  DIGIT  1  IS  NEVER  BLANKED. 

*** 

***  PORT  C  (I/O) 
*** 

***  4 -4 4 4 4 4 4 4 4 

***  |         BCD  DIGIT  #2         |BCD  DIGIT  #1(LEAST  SIGNIFICANT)! 

***  4 4 4- 4 --4 4 4 4 4 

***  |   D2   |   C2   |   B2   |   A2   |   D1   |   CI   |   B1   |   A1   | 

**»  4 4 4 4 4 4.. 4 4 4 

***  BIT      7      6      5     4      3      2      1       0 
*** 

*** 

***  PORT  D   (INPUT  ONLY) 
*** 

***  4 4 4 4 4 4 4 + + 

***  |  CH_A   |   INT2  |   CH_B  |  FUNCT  |   SET   |       |       |       | 

***  4 4 4 4 4 4 4 4. + 

***  BIT      7      6      5      4      3      2      1       0 

*** 

CH_A  EQU     7       INDICATES  THE  STATUS  OF  CHANNEL  A. 

INT2  EQU     6       INTERRUPT  #2.   USED  TO  CHANGE  DISPLAY  MODES. 

CH_B  EQU     5       INDICATES  THE  STATUS  OF  CHANNEL  B. 

FUNCT  EQU     4       USED  TO  PUT  THE  PROGRAM  IN  A  MODE  THAT  WILL  ALLOW 
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128 
129 
130 
131 
132 
133 
134 
135 
136 
137 
138 
139 
HO 
141 
142 
143 
144 
145 
146 
147 
148 
149 
150 
151 
152 
153 
154 
155 
156 
157 
158 
159 
160 
161 
162 
163 
164 
165 
166 
167 
168 
169 
170 
171 
172 
173 
174 
175 
176 
177 
178 
179 
180 
181 
182 
183 
184 
185 
186 
187 
188 
189 
190 
191 
192 
193 


0003 


0000 

0000 
0010 

0010 


0013 


0017 


001A 


0010 
0011 
0012 


0013 
0014 
0015 
0016 


0017 
0018 
0019 


001A 
001 B 
001C 
001D 


001E 


0021 


««« 

SET 
*»» 

»»» 


EOU 


>HYST'  TO  BE  INCREMENTED. 

INCREMENTS  <HYST'  WHEN  TOGGLED  AND  FUNCT  IS  LOW. 


*********** ************** 


*************** 


**  RAM  VARIABLES 

** 

** 

**  RESERVE  MEMORY  SPACE  FOR  THE  PROGRAM  VARIABLES. 

** 

DATA 

** 
** 

ABSOLUTE  (ABSOLUTE  ADDRESSING  USED  HERE  TO  RELATIVE  DIRECTIVE) 

*• 

ORG     RAM      START  OF  RAM. 


***  BINARY  COUNT. 
BINCT   RMB 
HIBIN   EQU 
MIDBIN  EQU 
LOBIN   EOU 


3 

BINCT  HI  BYTE. 

BINCT+1  MIDDLE  BYTE. 

BINCT+2  LO  BYTE. 


***  POSITION 
PTR     RMB 


POINTERS. 
4 


EQU 
EQU 
EOU 
EQU 


PTR 
PTR+1 
PTR+2 
PTR+3 


INTERS. 
3 


PTR4 
PTR3 
PTR2 
PTR1 

** 

***  COUNT  PO 
CTPTR   RMB 

** 

** 

CTPTR3  EQU 

CTPTR2  EQU 

CTPTR1   EQU 

** 

***  BCD  POSITION  IN  DEGREES. 
DEGRES  RMB 


EACH  BYTE  POINTS  TO  A  POSITION  IN  THE 
TABLE  THAT  CONTAINS  ONE  OR  TWO  DIGITS 
OF  THE  BCD  POSITION. 
MOST  SIGNIFICANT  DIGITS. 


LEAST  SIGNIFICANT  DIGIT. 


EACH  BYTE  POINTS  TO  A  POSITION  IN  THE 
TABLE  THAT  CONTAINS  TWO  OF  THE  DIGITS 
IN  THE  BCD  COUNT. 
MOST  SIGNIFICANT  DIGITS. 


CTPTR 

CTPTR+1 

CTPTR+2  LEAST  SIGNIFICANT  DIGITS. 


HUNDEG  EQU 

ONEDEG  EQU 

HUNDTH  EOU 

THOUTH  EOU 


4 

DEGRES 
DEGRES+1 
DEGRES+2 
DEGRES+3 


CONTENTS  X  100.000 

CONTENTS  X   1.000 

CONTENTS  X   0.010 

+  CONTENTS  X   0.001 


*** 
** 

POSITION  IN  DEGREES 

***  BCD 

COUNT. 

BCDCT 

RMB 

3 

001E 

TENTHO 

EOU 

BCDCT 

CONTENTS  X  10,000 

001 F 

HUNDRD 

EOU 

BCDCT+1 

CONTENTS  X    100 

0020 

TENONE 

EOU 

BCDCT+2 

+  CONTENTS  X      1 

***  NUMBER  OF  PULSES  COUNTED 

*** 

***  HYSTERESIS  COUNTER.  POINTS  TO  A  NUMBER  IN  THE  TABLE  THAT  IS  THE 
***      AMOUNT  OF  HYSTERESIS  PRESENT  IN  THE  SYSTEM.   INITIALIZED  TO  7. 
HYSTPT   RMB      1 

*» 

***  POSITION  INCREMENT.   CONTAINS  A  NUMBER,  THAT  WHEN  MULTIPLIED  BY  0.001 
***      IS  THE  NUMBER  OF  DEGREES  THAT  THE  POSITION  COUNTER  (BCDPOS)  IS 
***      TO  BE  INCREMENTED  OR  DECREMENTED  DURING  PROGRAM  EXECUTION. 
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194 

195 

196 

197 

198 

199 

200 

201 

202 

0022 

203 

204 

205 

206 

207 

0023 

208 

209 

0024 

210 

211 

212 

213 

0025 

214 

0026 

215 

216 

217 

218 

219 

220 

221 

222 

223 

224 

0027 

225 

226 

227 

228 

229 

230 

231 

232 

233 

234 

235 

236 

237 

238 

0000 

239 

240 

0080 

241 

242 

0080 

243 

244 

0080 

245 

246 

247 

248 

249 

250 

251 

252 

0080 

9B 

253 

0081 

9C 

254 

255 

0082 

AE  10 

256 

0084 

7F 

257 

0085 

5C 

258 

0086 

A3  27 

259 

0088 

23  FA 

THE  VALUE  OF  'POSINC,  DETERMINED  EXPERIMENTALLY,  SHOULD  BE 
7.0312.   SINCE  THE  PROGRAM  IS  DESIGNED  WORK  WITH  INTEGERS  ONLY 
THIS  NUMBER  IS  ROUNDED  TO  7.   TO  REDUCE  THE  CUMULATIVE  EFFECT  OF 
THE  ROUND  OFF,  EVERY  32  COUNTS  'POSINC  IS  SET  EQUAL  TO  8.   THIS 
AGAIN  LEADS  TO  SOME  CUMULATIVE  ERROR  THAT  IS  ACCOUNTED  FOR  BY 
SETTING  'POSINC  TO  7  INSTEAD  OF  8  UHEN  THE  COUNT  REACHES  A 
VALUE  OF  16384  (2*14). 


*** 
**• 

*•* 

MM 
MM 
MM 
MM 
MM 

POSINC  RMB     1 

MM 

***  HYSTERESIS  VARIABLES.  USED  TO  ELIMINATE  THE  EFFECTS  OF  BACKLASH  ON 
***      THE  POSITION  MEASUREMENTS. 

MM 

HYST    RMB     1       THE  THRESHHOLD  VALUE  DETERMINED 

***  EXPERIMENTALLY. 

HYSTCT  RMB     1       CURRENT  AMOUNT  OF  HYSTERESIS  MEASURED. 

MM 

•**  STATUS  BYTE.  USED  TO  KEEP  TRACK  OF  WHAT  IS  GOING  ON. 

MM 

STAT    RMB     1 
LSTAT   RMB     1 

MM 
MM 

***  TIMER  COUNTER.   USED  IN  CONJUNCTION  WITH  THE  TIMER  PRESCALER  AND  THE 
TDR  TO  KEEP  TRACK  OF  ONE  SEC.  INTERVALS.  USED  IN  BLINKING  THE 
DISPLAY.   INITIALLY  SET  TO  31,  WHEN  THE  'FLASH'  BIT  OF  'STAT' 
IS  SET.   TIMCT  IS  DECREMENTED  EACH  CLOCK  INTERRUPT  (APPROX.  31 
TIMES  PER  SEC).   RESET  TO  31  WHEN  CONTENTS  GO  TO  ZERO. 
WHEN  (TIMCT)=0  THE  DISPLAY  WILL  TOGGLE. 


CURRENT  STATUS. 

PREVIOUS/LAST  STATUS.  USED  TO  KEEP  TRACK  OF 

L  SET  ONLY. 


»** 

*** 
»** 
*** 
*** 
*** 
TIMCT 


RMB     1 


ENDS 
** 

**• 

MM****MMMM*MMMMMMMMMMMMMMMMMMMMMMMMMMMkMMMM*Mk*****MM 
■»*  * 

**  PAGE  ZERO  ROM 

**  * 

a*********************************************************************** 

**  INITIALIZATION  ROUTINE. 

** 

** 

CODE 


** 


ORG     ZROM    PAGE  ZERO  ROM. 

RELATIVE  ADDRESSING  MUST  BE  USED  FOR  THE  BRANCH. 
% 


THIS  IS  THE  ENTRY  POINT  WHEN  THE  RESET 
SWITCH  IS  PUSHED. 


RELATIVE 

*• 

RESTRT  EOU 

MM 

** 

ft*********************************************************************** 

** 

***  INITIALIZE  THE  PC  AND  CLEAR  RAM. 

•** 

*** 

SET  INTERUPT  TO  AVOID  INTERUPTION  AND 

RESET  THE  STACK  POINTER.  JUST  IN  CASE! 

CLEAR  ALL  OF  THE  VARIABLES  BETWEEN 
'BINCT'  AND  'TIMCT'  (INCLUSIVE). NOTE 
THAT  THIS  SETS  THE  COUNTER  AND  THE  POS- 
ITION TO  ZERO.  THIS  MEANS  THAT  ROTATION 
SHOULD  START  IN  AN  INCREASING  (CW) 


CLRIT 


SEI 

RSP 

LDX 

#8INCT 

CLR 

,x 

INCX 

CPX 

#timct 

BLS 

CLRIT 
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260 

261 

262 

263 

008A 

264 

265 

266 

267 

268 

269 

008A 

A6  FF 

270 

008C 

B7  04 

271 

008E 

B7  05 

272 

0090 

B7  06 

273 

274 

275 

0092 

CO  03  4E 

276 

277 

278 

279 

280 

0095 

A6  08 

281 

0097 

B4  03 

282 

0099 

B7  25 

283 

284 

009B 

1C  25 

285 

286 

287 

288 

289 

290 

0090 

A6  08 

291 

009F 

B7  23 

292 

00A1 

B7  21 

293 

294 

295 

296 

297 

298 

299 

300 

301 

302 

303 

00A3 

A6  47 

304 

305 

306 

307 

00A5 

B7  09 

308 

309 

310 

311 

312 

00A7 

A6  FF 

313 

00A9 

B7  08 

314 

315 

316 

317 

00AB 

A6  1F 

318 

OOAD 

B7  27 

319 

320 

321 

322 

323 

324 

325 

OOAF 

1D  OA 

DIRECTION  FROM  THE  MOST  CCW  POSITION 
AFTER  A  RESET. 


•** 
*** 

ABSOLUTE       BACK  TO  ABSOLUTE  ADDRESSING. 

*** 
***********»«»**»*«**»*»»»*»***«»*»*******«*******»*** 


LDA 
STA 
STA 
STA 


#-1 

PORTA+OOR 

PORTB+ODR 

PORTC+ODR 


*** 

JSR     OUTCT 

Mr* 
*********************** 

*** 


ESTABLISH  I/O  PORTS. 

PORTS  A,B,C  ARE  CONFIGURED  AS 
ALL  OUTPUT.  PORT  D  IS  ALL  INPUT 
SO  THERE  IS  NO  MASK  TO  SET. 


COUNT  IS  TO  BE  DISPLAYED  INITIALLY. 

************************* 


SET  UP  THE  STATUS  REGISTER. 


LDA 

AND 
STA 


#%0OO01000 

PORTD 

STAT 


->  SET  UP  »L  SET'  BIT  OF  'STAT'. 


BSET    MO0_32,STAT  0  IS  MODULO  32. 


*** 

***  INITIALIZE  HYSTCT. 

*** 

LDA    #08 
STA     HYST 
STA     HYSTPT 

*** 

************************************************************************ 

** 

**       SET  UP  THE  TIMER  FOR  A  4  MHZ  CRYSTAL  /  4  =  1  MHZ  CLOCK. 
*** 

***    NOTE:   THE  MASK  OPTION  REGISTER  IS  IN  ROM.   IT  IS  SET  UP  AT 

***  THE  END  OF  THE  PROGRAM. 

»** 

*********************   jEj  yp  fug  TCR.  ******************************** 

**• 

LDA      #BIT6+BIT2+BIT1+BIT0 
***  (TIM)|(PS2)(PS1)(PS0) 

"•(DISABLE  INTERRUPT) | (PRESCALE  BY  128) 
*•* 

STA     TCR 
•** 

*** 

***  SET  UP  THE  TIMER. 
*** 

LDA    #255    1  MHZ/(128*255)  =  30.6  (APPROX.  31) 

STA  TIMER 

*** 

••*••**••******* 
•** 

LDA     #31     PROVIDES  FOR  1  SEC.  BLINK  INTERVAL. 

STA     T1MCT   FOR  2  SEC.  INTERVAL  JUST  USE  TIMECT=62,  etc. 
*** 
*•* 

a********************************************************************* 

•* 

**  SET  UP  MISCELLANEOUS  REGISTER. 

** 

BCLR    B6.MR    ENABLES  THE  SECOND  INTERRUPT. 


INITIALIZE  THE  TIMER  COUNTER. 
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326 

** 

327 

** 

328 

00B1 

9A 

CI  I 

CLEAR  THE 

INTERRUPT  MASK  TO  GET  STARTED. 

329 

*** 

330 

00B2 

RELATIVE        RELATIVE  ADD     ING  MUST  BE  USE 

331 

*** 

REMAINDER 

OF  THE  PROGRAM. 

332 

**» 

333 

334 

** 

335 

**  WAI1 

'  LOOP. 

EXECUTES,  UNTIL  AN 

INTERRUPT  OCCURS. 

336 

** 

337 

00B2 

09 

03 

OB 

PAUSE 

BRCLR 

FUNCT.PORTD, CHHYST  WANT  TO  CHANGE  HYST? 

338 

** 

YES... GO  TO  CHHYST. 

339 

00B5 

06 

03 

04 

BRSET 

SET, PORTD, SBIT 

NO...'SET, PORTD'  SET? 

340 

00B8 

17  25 

BCLR 

L  SET, STAT 

NO... CLEAR  'L  SET, STAT' 

341 

00BA 

20 

F6 

BRA 

PAUSE 

AND  LOOP. 

342 

OOBC 

16 

25 

SBIT 

BSET 

L_SET,STAT 

YES... SET  »L  SET, STAT' 

343 

OOBE 

20 

F2 

BRA 

PAUSE 

AND... LOOP 

344 

M 

345 
346 

** 

347 

**  HYSTERESIS 

MODIFICATION  ROUTINE 

'.  PERMITS  MODIFICATION  OF  THE 

348 

**  HYSTERESIS 

BUFFER  WITHOUT  REPROGRAMMING. 

349 

** 

350 

ooco 

A6 

40 

CHHYST 

LDA 

#BIT6 

DISABLE  TIMER  INTERRUPT. 

351 

00C2 

B7 

09 

STA 

TCR 

352 

*** 

353 

00C4 

A6 

08 

LDA 

#%00001000 

SAVE  'L  SET' 

354 

00C6 

B4 

25 

AND 

STAT 

INTO 

355 

00C8 

B7 

26 

STA 

LSTAT 

'LSTAT'. 

356 

OOCA 

A6 

08 

LDA 

#%00001000 

357 

OOCC 

B4 

03 

AND 

PORTD 

1 SET, PORTD'  -->  ACCUMULATOR 

358 

OOCE 

B1 

26 

CMP 

LSTAT 

HAS  THE  SET  SWITCH  BEEN  CHANGED? 

359 

0000 

27 

15 

BEO 

DISPLA 

360 

*** 

YES... 

361 

0002 

A6 

08 

LDA 

#%00001000 

-- 

362 

0004 

B8 

25 

EOR 

STAT 

|-->CHANGE  'L  SET, ST AT', 

363 

0006 

B7 

25 

STA 

STAT 

•  - 

364 

0008 

3C 

23 

INC 

HYST 

THEN  INCREMENT  THE  HYSTERESIS 

365 

OODA 

3C 

21 

INC 

HYSTPT 

POINTER  AND  'HYST'... 

366 

*** 

367 

OODC 

B6 

21 

LDA 

HYSTPT 

-- 

368 

OODE 

A1 

19 

CMP 

#25 

-- 

369 

OOEO 

23 

05 

BLS 

DISPLA 

-- 

370 

*** 

--  BUT  NOT  ABOVE  25. 

371 

00E2 

4F 

CLRA 

THEN---> 

372 

00E3 

B7 

23 

STA 

HYST 

-- 

373 

00E5 

B7 

21 

STA 

HYSTPT 

-. 

374 

*** 

375 

00E7 

A6 

00 

DISPLA 

LDA 
STA 

#%00000000 
PORTA 

376 

00E9 

B7 

00 

377 

OOEB 

A6 

CO 

LDA 

«1 1000000 

-- 

378 

OOEO 

B7 

01 

STA 

PORTB 

\ 

/ 

379 

*** 

--  DISPLAY  CURRENT  'HYST'. 

380 

OOEF 

BE 

21 

LDX 

HYSTPT 

-- 

381 

00F1 

D6 

03 

BE 

LDA 

TABLE, X 

-- 

382 

00F4 

B7 

02 

STA 

PORTC 

-- 

383 

*** 

IS  'HYST'  SETTING  COMPLETE? 

384 

00F6 

09 

03 

C7 

BRCLR 

FUNCT.PORTD, CHHYST 

NO...  KEEP  CHECKING  'SET'. 

385 

00F9 

08 

25 

05 

BRSET 

POSCT, STAT, SHOPOS 

YES...  RESET  THE  DISPLAY. 

386 

OOFC 

CO 

03 

4E 

JSR 

OUTCT 

387 

OOFF 

20 

03 

BRA 

DUNCHG 

388 

*** 

389 

0101 

CD 

03 

68 

SHOPOS 

JSR 

OUTPOS 

390 

*** 

391 

0104 

OB 

25 

04 

DUNCHG 

BRCLR 

FLASH, STAT, NO  INT 

IF  THE  DISPLAY  IS  TO 

BLINK... 
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392 

0107 

A6 

07 

393 

0109 

B7 

09 

394 

01  OB 

20 

A5 

395 

396 

397 

398 

399 

400 

401 

402 

403 

404 

405 

406 

407 

408 

409 

410 

411 

412 

413 

414 

010D 

1F 

OA 

415 

416 

010F 

OA 

25  10 

417 

0112 

09 

25  07 

418 

0115 

1A 

25 

419 

420 

0117 

A6 

07 

421 

0119 

B7 

09 

422 

01  IB 

80 

423 

424 

011C 

18 

25 

425 

011E 

CO 

03  68 

426 

0121 

80 

427 

428 

0122 

A6 

47 

429 

0124 

B7 

09 

430 

0126 

19 

25 

431 

0128 

1B 

25 

432 

433 

01 2A 

CD 

03  4E 

434 

01 2D 

80 

435 

436 

437 

438 

439 

440 

441 

442 

443 

444 

012E 

445 

012E 

OF 

09  DC 

446 

447 

448 

0131 

1F 

09 

449 

450 

0133 

3A 

27 

451 

0135 

27 

01 

452 

453 

0137 

80 

454 

455 

0138 

A6 

1F 

456 

013A 

B7 

27 

457 

LDA 

#8IT2+BIT1*BIT0 

STA 

TCR 

NO  INT 

BRA 

PAUSE 

**» 

»» 

ENABLE  TIMER  INTERRUPT  AND  RESET 
TIMER  PRE  SCALER 
PRIOR  TO  RETURNING. 


**  MAXIMUM  EXECUTION  TIME  FOR  THE  REMAINDER  OF  THE  PROGRAM  OCCURS 

**  IF  THE  COUNTER  ROTATES  THROUGH  ZERO  AS  THE  DISPLAY  MODE  IS  CHANGED 

**  FROM  THE  BLINKING  MODE  TO  THE  COUNT  MODE  AT  THE  SAME  TIME  THAT  THE 

**  BLINKING  ROUTINE  IS  CAUSING  THE  DISPLAY  TO  TOGGLE  TO  SHOW  THE 

**  POSITION  IN  DEGREES. 

**     MAXIMUM  EXECUTION  TIME  «  140  ♦  184  ♦  708  *  1032  CLOCK  CYCLES. 

** 

**  MODE  CHANGE  ROUTINE.   CHANGES  THE  DISPLAY  MODE  FROM 

**       COUNT  ->  POSITION  ->  BLINKING  ->  COUNT  -> (ETC.) 

**  MAXIMUM  EXECUTION  TIME  OF  181  CLOCK  CYCLES  OCCURS  WHEN  THE 

**  DISPLAY  NODE  IS  CHANGED  FROM  DISPLAYING  THE  COUNT  TO  DISPLAYING 

**  THE  POSITION  (IN  DEGREES). 

**  IF  THE  DISPLAY  IS  CHANGED  FROM  BLINKING  TO  A  COUNT  DISPLAY 

•*  EXECUTION  TINE  IS  140  CLOCK  CYCLES. 


CHMODE  BCLR 

** 

BRSET 
BRCLR 
BSET 

** 

LDA 
STA 
RTI 

*» 

DISPOS  BSET 
JSR 
RTI 

** 

DIS_CT  LDA 
STA 

BCLR 

BCLR 

** 

JSR 
RTI 


B7,MR 


AVOID  REPEATED  INTERRUPTS. 


FLASH, STAT, DIS_CT   IF  FLASHING,  DISPLAY  COUNT... 
POSCT, ST AT, DISPOS   IF  SHOWING  COUNT,  DISPLAY  POSITION. 
FLASH, STAT        ELSE,  BLINK. 


#8IT2+BIT1+BIT0 
TCR 


POSCT, STAT 
OUTPOS 


ENABLE  TIMER  INTERRUPT  AND  RESET 
TIMER  PRESCALER. 


DISPLAY  CURRENT  POSITION,  AND  UAIT. 


#8 1 T6+B I T  2*B I T 1 +B I  TO  DISABLE  TIMER  INTERRUPT  AND  RESET 
TCR  TIMER  PRESCALER. 

POSCT, STAT 
FLASH, STAT 


OUTCT 


I 

J--  DISPLAY  CURRENT  COUNT,  AND  UAIT. 


**  BLINK  ROUTINE.   INTERRUPT  ROUTINE  TO  CHANGE  THE  DISPLAY  FROM  POSITION 
**       TO  COUNT  OR  VICE  VERSA  EVERY  31  ST  TIMER  INTERRUPT  IF  THE 
**       'FLASH'  BIT  OF  'STAT'  IS  SET. 

MAXIMUM  EXECUTION  TIME  OF  184  CLOCK  CYCLES  OCCURS  WHEN  THE 
DISPLAY  IS  TOGGLED  FROM  A  COUNT  DISPLAY  TO  A  POSITION  DISPLAY. 


*• 
** 
«« 

BLINK 


EOU 
BRCLR 


T I R, TCR, CHMODE 


BCLR    TIR.TCR 


DEC 
BEO 

RTI 


TIMCT 
CHGDIS 


CHGDIS 

LDA 

#31 

STA 

TIMCT 

IF  THE  INTERRUPT  WAS  NOT  A  TIMER 
INTERRUPT  IT  MUST  BE  FROM  INT2. 

AVOID  REPEATED  TIMER  INTERRUPTS. 

IF  THERE  HAVE  BEEN  31  TIMER 
INTERRUPTS   (1  SEC),  IT'S  TIME  TO 
CHANGE  THE  DISPLAY. 
OTHERWISE,  IT'S  BACK  TO  WORK. 

RESET  TIMCT  TO  31  (1  SEC.  INTERVAL). 
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458 

013C 

B6  25 

459 

013E 

A8  10 

460 

0140 

B7  25 

461 

462 

0142 

08  25  04 

463 

464 

465 

466 

0145 

CO  03  4E 

467 

0148 

80 

468 

469 

470 

471 

0149 

CD  03  68 

472 

01 4C 

80 

473 

474 

475 

476 

477 

478 

479 

480 

481 

482 

483 

484 

485 

486 

487 

488 

489 

490 

491 

492 

493 

494 

495 

496 

497 

498 

499 

500 

501 

OKD 

502 

014D 

OA  03  01 

503 

0150 

80 

504 

505 

506 

507 

0151 

A6  7F 

508 

0153 

B4  25 

509 

0155 

B7  25 

510 

0157 

A6  80 

511 

0159 

B4  03 

512 

513 

015B 

BA  25 

514 

015D 

B7  25 

515 

516 

517 

518 

015F 

OE  25  09 

519 

0162 

B6  24 

520 

0164 

27  60 

521 

522 

0166 

AO  01 

523 

0168 

B7  24 

LOA  STAT 

eor         nrxooo  10000 

STA     STAT 


CHANGE  'POSCT'  BIT  OF  'STAT' 


BRSET   POSCT, STAT, POSOUT     DECIDE  ON  CORRECT  DISPLAY. 


************  CHANGE  THE  DISPLAY  TO  SHOW  THE  COUNT. 

** 

JSR     OUTCT 
RTI 


************  OR  HAVE  THE  DISPLAY  SHOW  THE  POSITION.  ****************** 


POSOUT  JSR     OUTPOS 
RTI 

** 
Ik***************************************** 

** 

** 
** 
** 
•* 

** 


COUNT  ROUTINE. 
WHEN  A  COUNT  IS  RECEIVED  THIS  IS  THE  ENTRY  POINT  . 
MAXIMUM  EXECUTION  TIME  OF  708  CLOCK  CYCLES  OCCURS  WHEN  THE 
COUNTER  ROTATES  CCW  THROUGH  ZERO  AND  THE  POSITION  (IN  DEGREES) 
IS  BEING  DISPLAYED. 


**  CURRENT  DIRECTION  OF  ROTATION  IS  DETERMINED  BY  INSPECTING  THE  STATUS 
**  OF  'CH_A'  AND  'CH_B'.  THE  FOUR  POSSIBILITIES  AND  THE  ASSOCIATED 
**  DIRECTION  OF  ROTATION  ARE  AS  SHOWN  BELOW.  NOTE  THAT  THIS  SCHEME 
**  PREVENTS  MULTIPLE  OSCILLATIONS  ABOUT  A  SINGLE  POINT  FROM 
**  REPEATEDLY  INCREMENTING  OR  DECREMENTING  THE  COUNTER. 


** 
*» 
»* 

** 
** 
** 
** 
** 
** 
** 


+ + +  .. ... 

I  CH_A   |   CH_B   |   DIRECTION 

OF  ROTATION 
+ + + 

|   LO   |    LO   |      CW 
LO       HI         CCW 
HI       LO         CCW 
HI       HI         CU 

+ + + 


.+ + 

|  COUNT  THE  PULSE?  | 

I  I 

-+-- + 

I        NO         | 

YES 

NO 

I        YES        | 

-+--- - + 


********  FIRST  SEE  IF  WE  ARE  SUPPOSED  TO  COUNT  THIS  INTERUPT 

** 

COUNT   EOU     S 

BRSET   CH_B, PORTD, OKCT    IF  CH_B  IS  LO  WE  DON'T  COUNT  THE 


******** 


RTI 


INTERRUPT. 


**************  1F  THE  iNTERRUpT  IS  VALID  UPDATE  'STAT', 

** 
OKCT 


************** 


LDA 

#%01111111 

AND 

STAT 

STA 

STAT 

LDA 

tf%1 0000000 

AND 

PORTD 

ORA 

STAT 

STA 

STAT 

SAVE  ALL  OF  THE  OLD  'STAT'  EXCEPT  THE 
DIRECTION  OF  ROTATION. 

»CH  A, PORTD'  INDICATES  THE  DIRECTION 
OF  ROTATION  AND  BECOMES  'UD.STAT'. 
ADD  THE  RESULTS  TO  GET 
THE  NEW  'STAT'. 


**  DECIDE  IF  THE  "SLACK"  DUE  TO  BACKLASH/HYSTERESIS  HAS  BEEN  TAKEN  OUT. 

•* 

BRSET  UD.STAT.HYSTCK  IF  ROTATING  CU  SEE  BELOW. 

LDA  HYSTCT  ELSE,  SEE  IF  WE  DECREMENT  THIS  TIME. 

BEQ  CCU  IF  HYSTCT=0,  GO  TO  THE  COUNT  DOUN 

**  ROUTINE. 

SUB  #1  ELSE,  DECREMENT  THE  HYSTERESIS  COUNTER, 

STA  HYSTCT 
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524 

016A 

80 

525 

526 

0168 

B6 

23 

527 

0160 

B1 

24 

528 

016F 

27 

03 

529 

0171 

3C 

24 

530 

0173 

80 

531 

532 

533 

534 

535 

536 

537 

0174 

538 

539 

540 

541 

542 

0174 

B6 

12 

543 

0176 

AB 

01 

544 

0178 

B7 

12 

545 

546 

01 7k 

B6 

11 

547 

017C 

A9 

00 

548 

017E 

B7 

11 

549 

550 

0180 

B6 

10 

551 

0182 

A9 

00 

552 

0184 

B7 

10 

553 

554 

555 

556 

557 

558 

559 

560 

561 

562 

563 

0186 

B6 

12 

564 

0188 

A4 

1F 

565 

018A 

26 

OF 

566 

018C 

B6 

11 

567 

018E 

27 

07 

568 

0190 

A4 

3F 

569 

0192 

26 

03 

570 

0194 

00 

11  04 

571 

572 

0197 

1C 

25 

573 

0199 

20 

02 

574 

575 

019B 

1D 

25 

576 

577 

578 

0190 

B6 

10 

579 

019F 

2B 

ID 

580 

581 

582 

01A1 

26 

14 

583 

01A3 

B6 

11 

584 

01A5 

26 

10 

585 

01A7 

B6 

12 

586 

01A9 

26 

OC 

587 

588 

589 

01AB 

15 

25 

RTI 

** 

HYSTCK 

LDA 

HYST 

CMP 

HYSTCT 

BEQ 

CW 

INC 

HYSTCT 

RTI 

AND  WAIT  FOR  THE  NEXT  INTERRUPT. 

IF  ROTATING  CW 

AND  HYST  *  HYSTCT  

COUNT  THE  PULSE  . 

ELSE,  INCREMENT  THE  HYSTERESIS  COUNTER, 

AND  WAIT  FOR  ANOTHER  PULSE. 


►*•*»»»«»»»*«»***** 


CLOCKWISE  ROUTINE. 


CW 


EQU 


******•*•*•***  INCREMENT  THE  BINARY  COUNTER  (BINCT).  ***************** 


LDA 
ADO 
STA 

LDA 
ADC 

STA 

LDA 
ADC 
STA 


LOBIN   BEGIN  AT  THE  LSB  OF  THE  BINARY  COUNTER. 
#1      LOBIN  =  LOBIN  ♦  1  ;  CARRY  ->  C.CCR 
LOBIN 


MIDBIN 

#0 

MIDBIN 

HIBIN 

#0 
HIBIN 


ADD  THE  CARRY  TO  THE  MIDDLE  BYTE. 


ADD  THE  CARRY  TO  THE  HIGH  BYTE. 


CLR/SET  MOO  32  APPROPRIATELY. 


*»* 
*** 
*** 
•** 

•** 
*•* 


THE  FOLLOWING  SEVERAL  LINES  OF  CODE  ARE  PRETTY  MESSY.  ALL  THAT 
IS  BEING  DONE  IS  TO  ENSURE  THAT  THE  SCALE  FACTOR  IS  SET  PROPERLY. 
FOR  THE  PAN  AXIS  THE  SCALE  FACTOR  IS; 


1  PULSE  =>  0.007097  DEGREES 


LDA 
AND 
BNE 
LDA 
BEQ 
AND 
BNE 


LOBIN 
#%00011111 

NOT  32 

MIDBIN 

MOO 

#X001 11111 

MOD 


IF  THE  LOW  FIVE  BITS  OF  'LOBIN'  ARE  NOT 

ZERO  THEN  THE  NUMBER  ISN'T  A  MODULO  32  NUMBER. 

IF  THE  LOW  SIX  BITS  OF  'MIDBIN'  ARE  ZERO 
AND  'HIBIN'  .NE.  ZERO 

THEN  THE  NUMBER  IS  MODULO  16,384,  AND  WE 
DON'T  WANT  TO  SET  'MOO  32, STAT',  UNLESS 


*** 
MOO 

*•• 

NOT_32 

•** 

*** 
DIRCHK 

*** 

*•• 


BRCLR  B6, MIDBIN, NOT_32  THE  NUMBER  IS  ALSO  MOOULO  32,768. 

BSET  MOD_32,STAT 

BRA  DIRCHK 

BCLR  MOD_32,STAT 


LDA 
BMI 


BNE 
LDA 
BNE 
LDA 
BNE 


BCLR 


HIBIN 
CWNEG 


CWPOS 

MIDBIN 

CWPOS 

LOGIN 

CWPOS 


IF  HIBIN  <  0 
THE  ORIGIN. 


WE'RE  ROTATING  CCW  TOWARD 


NEGTIV.STAT 


ELSE  IF  BINCT  .NE.  0 
WE'RE  ROTATING  CW 
AWAY  FROM  THE  ORIGIN. 


ELSE,  WE'VE  ROTATED  CW  THROUGH  THE  ORIGIN. 
CLR  NEGATIVE  SIGN. 
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590 

01A0 

AE 

13 

591 

01AF 

7F 

592 

01B0 

5C 

593 

01B1 

A3 

1D 

594 

01 B3 

23 

FA 

595 

01B5 

20 

66 

596 

597 

01B7 

AD 

74 

598 

01 B9 

CO 

02  6A 

599 

01 BC 

20  64 

600 

601 

01  BE 

CD 

02  CA 

602 

01C1 

CD 

02  6A 

603 

01C4 

20 

5C 

604 

605 

606 

607 

608 

609 

610 

01C6 

611 

612 

613 

614 

615 

616 

617 

618 

619 

01C6 

B6 

12 

620 

01C8 

A4 

1F 

621 

01CA 

26 

OF 

622 

01CC 

B6 

11 

623 

01CE 

27 

07 

624 

01D0 

A4 

3F 

625 

01D2 

26 

03 

626 

01D4 

OD 

11  04 

627 

628 

01D7 

1C 

25 

629 

01D9 

20 

02 

630 

631 

01DB 

1D 

25 

632 

633 

634 

635 

636 

01DD 

B6 

12 

637 

01DF 

AO 

01 

638 

01E1 

B7 

12 

639 

640 

01E3 

B6 

11 

641 

01E5 

A2 

00 

642 

01E7 

B7 

11 

643 

644 

01E9 

B6 

10 

645 

01EB 

A2 

00 

646 

01ED 

B7 

10 

647 

648 

01EF 

B6 

10 

649 

01F1 

2A 

29 

650 

651 

01F3 

A6 

FF 

652 

01 F5 

B1 

10 

653 

01F7 

26 

1C 

654 

01 F9 

B1 

11 

655 

01FB 

26 

18 

LDX 

#PTR4 

CLRIT2 

CLR 
INCX 

,x 

CPX 

DfTHOUTH 

BLS 

CLRIT2 

BRA 

UPOUT 

MM 

euros 

BSR 

ADDBCD 

JSR 

iNcros 

BRA 

UPOUT 

«** 

CUNEG 

JSR 

SUBBCD 

JSR 

INCPOS 

BRA 

UPOUT 

*** 

** 

-RESET  ALL  COUNTERS  AND  DEGRES  TO  ZERO. 


UPDATE  OUTPUT. 


COUNTER-CLOCKWISE  ROUTINE. 


EQU 


ecu 

** 

*** 

******************  CLR/SET  MOO  32  APPROPRIATELY.  ********************* 

*** 
*•* 


*** 

*•* 
*** 


AGAIN  SET  THE  SCALE  FACTOR  TO; 

1  PULSE  =>  0.007097  DEGREES 


LDA 
AND 
BNE 
LDA 
BEO 
AND 
BNE 


LOBIN 

#X00011111 

NO  32 

MIDBIN 

MODLO 

«00111111 

MODLO 


IF  THE  LOU  FIVE  BITS  OF  «L06IN'  ARE  NOT 

ZERO  THEN  THE  NUMBER  ISN'T  A  MODULO  32  NUMBER. 

IF  THE  LOU  SIX  BITS  OF  'MIDBIN'  ARE  ZERO 
AND  'HIBIN'  .NE.  ZERO 

THEN  THE  NUMBER  IS  MODULO  16,384,  AND  UE 
DON'T  UANT  TO  SET  'MOO  32, STAT',  UNLESS 


*** 
MODLO 


BRCLR   B6, MIDBIN, NO_32  THE  NUMBER  IS  ALSO  MODULO  32,768. 


BSET 
BRA 


MOD_32,STAT 
DECBIN 


BCLR    MOD_32,STAT 


N0_32 
*** 

*** 

*************** 

*** 

DECBIN  LDA 

SUB 


DECREMENT  THE  BINARY  COUNTER  (BINCT). 


**************** 


*** 


STA 

LDA 
SBC 
STA 

LDA 
SBC 

STA 

LDA 
BPL 

LDA 
CMP 
BNE 
CMP 
BNE 


LOBIN 

#1 

LOBIN 

MIDBIN 

#0 

MIDBIN 

HIBIN 

#0 

HIBIN 

HIBIN 
CCUPOS 

#-1 

HIBIN 

CCUNEG 

MIDBIN 

CCUNEG 


BEGIN  AT  THE  LSB  OF  THE  BINARY  COUNTER. 
LOBIN  =  LOBIN  -  1  ;  BORROW  ->  C,CCR 


SUBTRACT  THE  CARRY  FROM  THE  MIDDLE  BYTE. 


SUBTRACT  THE  CARRY  FROM  THE  HIGH  BYTE. 


IF  HIBIN  .GE.  0  ,  WE'RE  ROTATING  CCU  TOWARD 
THE  ORIGIN. 


ELSE  IF  BINCT  .NE.  -1  , 
WE'RE  ROTATING  CCU  AUAY 
FROM  THE  ORIGIN. 
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656 

01 FD 

B1 

12 

657 

01FF 

26 

14 

658 

659 

0201 

14 

25 

660 

661 

662 

0203 

A6 

03 

663 

0205 

B7 

13 

664 

0207 

B7 

1A 

665 

0209 

A6  3C 

666 

020B 

B7 

14 

667 

0200 

AE 

15 

668 

020F 

7F 

669 

0210 

5C 

670 

0211 

A3 

19 

671 

0213 

23 

FA 

672 

673 

0215 

AD 

16 

674 

0217 

CO 

02  FD 

675 

021A 

20 

06 

676 

677 

021C 

CO 

02  CA 

678 

021 F 

CD 

02  FD 

679 

680 

681 

682 

683 

684 

685 

686 

687 

688 

0222 

689 

690 

0222 

09 

25  04 

691 

692 

0225 

CD 

03  68 

693 

0228 

80 

694 

695 

0229 

CD 

03  4E 

696 

022C 

80 

697 

698 

699 

700 

701 

022D 

B6 

19 

702 

022  F 

AB 

01 

703 

0231 

A1 

63 

704 

0233 

23 

05 

705 

0235 

AO 

64 

706 

0237 

99 

707 

0238 

20 

01 

708 

709 

023A 

98 

710 

0236 

B7 

19 

711 

023D 

97 

712 

713 

023E 

D6 

03  BE 

714 

0241 

B7 

20 

715 

0243 

24 

24 

716 

717 

718 

0245 

B6 

18 

719 

0247 

A9 

00 

720 

0249 

A1 

63 

721 

024B 

23 

05 

CMP 

LOBIN 

*** 

BNE 

CCWNEG  -- 

BSET 

NEGTIV.STAT 

*** 

*** 

LDA 

#03 

STA 

PTR4 

STA 

HUNDEG 

LDA 

#60 

STA 

PTR3 

LDX 

#PTR2   -- 

CLREM 

CLR 
INCX 

,x 

CPX 

#CTPTR1 

BLS 

CLREM 

*** 

CCWNEG 

BSR 

ADOBCD 

JSR 

DECPOS 

BRA 

UPOUT 

*** 

CCWPOS 

JSR 

SUBBCD 

JSR 

DECPOS 

*** 

ELSE,  WE'VE  GONE  THROUGH  ORIGIN  IN  CCW 

DIRECTION.   SET  NEGATIVE  SIGN. 

AMD  SET  ALL  COUNTERS  APPROPRIATELY. 


■-  DEGRES  =  360.00 


•-  EVERYTHING  ELSE  IS  ZERO  BEFORE  CHANGE. 


************************************************************************ 

** 

**  OUTPUT  ROUTINE.  ROUTINE  TO  PRINT  DATA  TO  THE  OUTPUT  PORTS.   BY 

**       CALLING  THE  APPROPRIATE  SUBROUTINE.COUTCT'  TO  OUTPUT  THE 

**       THE  COUNT  AND  'OUTPOS'  TO  OUTPUT  THE  POSITION). 


UPOUT 

EOU 

S 

*» 

BRCLR 

POSCT, STAT, PUTCT 

»* 

JSR 

OUTPOS 

RTI 

** 

PUTCT 

JSR 
RTI 

OUTCT 

*• 

************************************************************************ 
***********  SUBROUTINE  TO  INCREMENT  THE  BCD  COUNTER  (BCDCT).   ********* 


CTPTR  >  99  ? 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  FIRST  TWO  DIGITS. 

YES...  MODIFY  THE  CTPTR, 

SET  THE  CARRY,  AND 

USE  TABLE  LOOK  UP. 


»*» 

ADDBCD 

LDA 

CTPTR1 

ADD 

#1 

CMP 

#99 

BLS 

OK1 

SUB 

#100 

SEC 

BRA 

OK1A 

*** 

OKI 

CLC 

OK1A 

STA 
TAX 

CTPTR1 

*** 

LDA 

TABLE, X 

STA 

TENONE 

BCC 

NOMO 

*** 

*** 

LDA 

CTPTR2 

ADC 

#0 

CMP 

#99 

BLS 

OK2 

NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT. 


LOOK  UP  THE  TWO  LEAST  SIGNIFICANT  DIGITS. 


AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 


ADD  THE  CARRY. 

CTPTR  >  99  ? 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 
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722 

024D 

A0  64 

723 

024  F 

99 

724 

0250 

20  01 

725 

726 

0252 

98 

727 

0253 

B7  18 

728 

0255 

97 

729 

730 

0256 

D6  03  BE 

731 

0259 

B7  1F 

732 

025B 

24  OC 

733 

734 

025D 

B6  17 

735 

025  F 

A9  00 

736 

0261 

B7  17 

737 

0263 

97 

738 

739 

0264 

D6  03  BE 

740 

0267 

B7  1E 

741 

742 

0269 

81 

743 

744 

745 

746 

747 

748 

749 

750 

026A 

00  25  04 

751 

752 

0260 

A6  08 

753 

026F 

20  02 

754 

755 

0271 

A6  07 

756 

0273 

B7  22 

757 

758 

759 

760 

761 

0275 

B6  16 

762 

0277 

BB  22 

763 

0279 

A1  09 

764 

027B 

23  05 

765 

0270 

AO  OA 

766 

027F 

99 

767 

0280 

20  01 

768 

769 

0282 

98 

770 

0283 

B7  16 

771 

0285 

97 

772 

773 

0286 

06  03  BE 

774 

0289 

B7  1D 

775 

0286 

24  3C 

776 

777 

778 

0280 

B6  15 

779 

028F 

A9  00 

780 

0291 

A1  63 

781 

0293 

23  05 

782 

0295 

AO  64 

783 

0297 

99 

784 

0298 

20  01 

785 

786 

029A 

98 

787 

029B 

B7  15 

SUB 

#100 

SEC 

BRA 

0K2A 

*** 

0K2 

CLC 

0K2A 

STA 
TAX 

CTPTR2 

*** 

LOA 

TABLE, X 

STA 

HUNDRD 

BCC 

MOMO 

*** 

LDA 

CTPTR3 

ADC 

#0 

STA 

CTPTR3 

TAX 

MM 

LDA 

TABLE, X 

STA 

TENTHO 

#100    YES...  MODIFY  THE  CTPTR, 
SET  THE  CARRY,  AMD 


NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT. 
•-  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

ADD  THE  CARRY. 
••  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 


NOMO 

*** 


RTS 


*******  SUBROUTINE  TO  INCREMENT  THE  POSITION  COUNTER  (DEGRES).   ******* 

*** 

****  FIRST  CHECK  TO  SEE  IF  THE  BINARY  COUNTER  HAS  REACHED  A  MODULO  32 

****     NUMBER. 

**** 

INCPOS  BRCLR   MOD_32,STAT, INC7   'MOD_32,STAT'  SET  ? 
**•• 

LDA     #8  YES  ... 

BRA     INC  INCREMENT  THE  POSITION  BY  0.008  DEGREES. 

LDA     #7  NO 

STA     POSINC        INCREMENT  THE  POSITION  BY  0.007  DEGREES. 


**** 
INC7 
INC 


****  ROUTINE  TO  INCREMENT  THE  POSITION  COUNTER  , 'DEGREES' , BY  A 
*•**     PREDETERMINED  AMOUNT,  'POSINC. 


PTR1  >  9  ? 

NO,  WE'RE  OK  HERE.   LOOK  UP  THE  FIRST  DIGIT. 

YES...  MODIFY  THE  CTPTR, 

SET  THE  CARRY,  AND 

USE  TABLE  LOOK  UP. 


**** 

LDA 

PTR1 

ADD 

POSINC 

CMP 

#9 

BLS 

OK3 

SUB 

#10 

SEC 

BRA 

OK3A 

**** 

OK3 

CLC 

0K3A 

STA 
TAX 

PTR1 

*•** 

LDA 

TABLE, X 

STA 

THOUTH 

BCC 

DONE 

**** 

**** 

LDA 

PTR2 

ADC 

#0 

CMP 

#99 

BLS 

OK4 

SUB 

#100 

SEC 

BRA 

OK4A 

**** 

OK4 

CLC 

OK4A 

STA 

PTR2 

NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT. 


LOOK  UP  THE  LEAST  SIGNIFICANT  DIGIT. 


AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 


ADD  THE  CARRY. 

PTR2  >  99  ? 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

YES... MODIFY  THE  CTPTR, 

SET  THE  CARRY, 

AND  USE  TABLE  LOOK  UP. 

NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT. 


99 


788 

0290 

97 

789 

790 

029E 

D6  03  BE 

791 

02A1 

B7  1C 

792 

02A3 

24  24 

793 

794 

795 

02A5 

B6  14 

796 

02A7 

A9  00 

797 

02A9 

A1  63 

798 

02AB 

23  05 

799 

02AD 

A0  64 

800 

02AF 

99 

801 

02B0 

20  01 

802 

803 

02B2 

98 

804 

02B3 

B7  14 

805 

02B5 

97 

806 

807 

02B6 

D6  03  BE 

808 

02B9 

B7  1B 

809 

02BB 

24  OC 

810 

811 

02BD 

B6  13 

812 

02BF 

A9  00 

813 

02C1 

B7  13 

814 

02C3 

97 

815 

816 

02C4 

06  03  BE 

817 

02C7 

B7  1A 

818 

819 

02C9 

81 

820 

821 

822 

823 

824 

825 

02CA 

B6  19 

826 

02CC 

AO  01 

827 

02CE 

24  03 

828 

0200 

AB  64 

829 

0202 

99 

830 

831 

02D3 

B7  19 

832 

02D5 

97 

833 

834 

02D6 

D6  03  BE 

835 

02D9 

B7  20 

836 

02DB 

24  1F 

837 

838 

839 

02OD 

B6  18 

840 

020  F 

A2  00 

841 

02E1 

24  03 

842 

02E3 

AB  64 

843 

02E5 

99 

844 

845 

02E6 

B7  18 

846 

02E8 

97 

847 

848 

02E9 

D6  03  BE 

849 

02EC 

B7  1F 

850 

02EE 

24  OC 

851 

852 

02F0 

B6  17 

853 

02F2 

A2  00 

TAX 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 


LDA 

TABLE, X 

-- 

STA 

HUNDTH 

-- 

BCC 

DONE 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

*#** 

**** 

LDA 

PTR3 

ADC 

•0 

ADO  THE  CARRY. 

CMP 

#99 

PTR3  >  99  ? 

BLS 

OK5 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

SUB 

#100 

YES...  MODIFY  THE  CTPTR, 

SEC 

SET  THE  CARRY,  AND 

BRA 

0K5A 

USE  TABLE  LOOK  \X>. 

**** 

0K5 

CLC 

NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT. 

OKSA 

STA 

PTR3 

-- 

TAX 

-- 

HM 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

LDA 

TABLE, X 

-- 

STA 

ONEDEG 

-- 

BCC 

DONE 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

MM 

LDA 

PTR4 

ADC 

#0 

ADD  THE  CARRY. 

STA 

PTR4 

-- 

TAX 

-- 

***• 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

LDA 

TABLE, X 

-- 

STA 

HUNDEG 

-- 

**** 

DONE 

RTS 

*•• 

** 

********   SUBROUTINE  TO 

DECREMENT  THE  BCD  COUNTER  (BCDCT).   ************ 

*** 

SUBBCD 

LDA 

CTPTR1 

SUB 

#1 

CTPTR  >  99  ? 

BCC 

0K6 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  FIRST  TWO  DIGITS. 

ADD 

#100 

YES,  MODIFY  THE  CTPTR,  AND 

SEC 

GENERATE  A  BORROW. 

*** 

OK6 

STA 

CTPTR1 

-- 

TAX 
***  --  LOOK  UP  THE  TWO  LEAST  SIGNIFICANT  DIGITS. 

LDA     TABLE, X 

STA     TENONE   -- 

BCC     COMPLT        AND  CONTINUE  ONLY  IF  THERE  WAS  A  BORROW. 
»** 

«** 

LDA  CTPTR2 

SBC  #0  SUBTRACT  THE  CARRY.  CTPTR  >  99  ? 

BCC  OK7  NO,  WE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

ADD  #100  YES,  MODIFY  THE  CTPTR,  AND 

SEC  GENERATE  A  BORROW. 

*** 

OK7     STA     CTPTR2  -- 

TAX 
***  --  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

LDA     TABLE, X 

STA     HUNDRD   -- 

BCC     COMPLT  AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

*** 

LDA     CTPTR3 

SBC  #0  SUBTRACT   THE   BORROW. 
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854 

02F4 

B7 

17 

STA 

CTPTR3 

-- 

855 

02F6 

97 

TAX 

— 

856 

MM 

■-  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE 

857 

02F7 

06 

03 

BE 

LDA 

TABLE ,X 

-- 

858 

02FA 

B7 

1E 

STA 

TENTHO 

•- 

859 

MM 

860 

02FC 

81 

COMPLT 

RTS 

861 

MM 

862 
863 

*******  SUBROUTINE  TO  DECREMENT  THE  POSITION  COUNTER  (DEGRES).   ******* 

864 

MM 

865 

****   | 

:IRST  CHECK  TO     IF  THE   I NARY  COUNTER  HAS  REACHED  A  MODULO 

866 

MM* 

NUMBER 

, 

867 

MM* 

868 

02FD 

00 

25 

04 

DECPOS 

BRCLR 

MOD_32, 

STAT.DEC7        'MOD_32,STAT'  SET  ? 

869 

MM* 

870 

0300 

A6  0 

LDA 

08 

YES... 

871 

0302 

20 

02 

BRA 

DEC 

DECREMENT  THE  POSITION  BY  0.008  DEGREES. 

872 

MM* 

873 

0304 

A6 

07 

DEC7 

LDA 

#7 

NO 

874 

0306 

B7  22 

DEC 

STA 

POSINC 

DECREMENT  THE  POSITION  BY  0.007  DEGREES. 

875 

**** 

876 

****  ROUTINE  TO 

DECREMENT  THE  POSITION  COUNTER  , 'DEGREES' , BY  A 

877 

**** 

PREDETERMINED 

AMOUNT,  'POSINC. 

878 

MM* 

879 

0308 

B6 

16 

LDA 

PTR1 

880 

030A 

BO 

22 

SUB 

POSINC 

PTR1  <  0  ? 

881 

030C 

24 

03 

BCC 

OK8 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  FIRST  DIGIT. 

882 

030E 

AB 

OA 

ADD 

#10 

YES,  MODIFY  THE  CTPTR,  AND 

883 

0310 

99 

SEC 

GENERATE  A  BORROW. 

884 

**** 

885 

0311 

B7 

16 

0K8 

STA 

PTR1 

-- 

886 

0313 

97 

TAX 

.. 

887 

*MM 

--  LOOK  UP  THE  LEAST  SIGNIFICANT  DIGIT. 

888 

0314 

D6 

03 

BE 

LDA 

TABLE, X 

-- 

889 

0317 

B7 

10 

STA 

THOUTH 

-- 

890 

0319 

24 

32 

BCC 

DUNSUB 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  BORROW. 

891 

*** 

892 

*** 

893 

031B 

B6 

15 

LDA 

PTR2 

894 

031D 

A2 

00 

SBC 

#0 

SUBTRACT  THE  BORROW.   PTR2  <  0  ? 

895 

031 F 

24 

03 

BCC 

OK9 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

896 

0321 

AB 

64 

ADD 

#100 

YES,  MODIFY  THE  CTPTR,  AND 

897 

0323 

99 

SEC 

GENERATE  A  BORROW. 

898 

*** 

899 

0324 

B7 

15 

0K9 

STA 

PTR2 

-- 

900 

0326 

97 

TAX 

-- 

901 

*** 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

902 

0327 

D6 

03 

BE 

LDA 

TABLE, X 

-- 

903 

032A 

B7 

1C 

STA 

HUNDTH 

-- 

904 

032C 

24 

1F 

BCC 

DUNSUB 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

905 

*** 

906 

MM 

907 

032E 

B6 

14 

LDA 

PTR3 

908 

0330 

A2 

00 

SBC 

#0 

SUBTRACT  THE  BORROW.   PTR3  <  0  ? 

909 

0332 

24 

03 

BCC 

OK10 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

910 

0334 

AB 

64 

ADD 

#100 

YES,  MODIFY  THE  CTPTR,  AND 

911 

0336 

99 

SEC 

GENERATE  A  BORROW. 

912 

MM* 

913 

0337 

B7 

14 

OK10 

STA 

PTR3 

-- 

914 

0339 

97 

TAX 

-- 

915 

**** 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE 

916 

033A 

D6 

03 

BE 

LDA 

TABLE, X 

-- 

917 

0330 

B7 

1B 

STA 

ONEDEG 

-- 

918 

033  F 

24 

OC 

BCC 

DUNSUB 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

919 

**** 
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920 

0341 

B6 

13 

921 

0343 

A2 

00 

922 

0345 

B7 

13 

923 

0347 

97 

924 

925 

0348 

D6 

03  BE 

926 

034B 

B7 

1A 

927 

928 

034D 

81 

929 

930 

931 

932 

933 

934 

935 

936 

937 

938 

939 

034E 

940 

941 

034E 

B6 

20 

942 

0350 

B7 

02 

943 

944 

0352 

B6 

1F 

945 

0354 

B7 

00 

946 

947 

0356 

B6 

1E 

948 

0358 

B7 

01 

949 

950 

035A 

1E 

01 

951 

035C 

19 

01 

952 

953 

035E 

04 

25  04 

954 

0361 

1C 

01 

955 

0363 

20 

02 

956 

957 

0365 

1D 

01 

958 

959 

0367 

81 

960 

961 

962 

963 

964 

965 

966 

0368 

967 

968 

0368 

B6 

1D 

969 

036A 

A1 

05 

970 

036C 

25 

38 

971 

036E 

B6 

1C 

972 

0370 

A4 

09 

973 

0372 

A1 

09 

974 

0374 

26 

28 

975 

0376 

B6 

1C 

976 

0378 

A1 

99 

977 

037A 

27 

04 

978 

037C 

AB 

07 

979 

037E 

20 

28 

980 

981 

982 

0380 

A6 

00 

983 

0382 

B7 

02 

984 

0384 

99 

985 

LOA 

PTR4 

SBC 

#0      SUBTRACT  THE  BORROW 

STA 

PTR4 

TAX 

-- 

**** 

--  LOOK  UP  THE 

LDA 

TABLE, X   -- 

STA 

HUNOEG  -- 

***» 

DUN SUB 

RTS 

it********************** 

M 

**  OUTPUT  COUNT  (OUTCT).   SUBROUTINE  TO  MOVE  THE  CURRENT  COUNT  (BCDCT) 

**       TO  THE  OUTPUT  PORTS.  REMOVES  THE  DECIMAL  POINT  FROM  THE 

**      DISPLAY  AND  BLANKS  ALL  BUT  THE  LEAST  SIGNIFICANT  DIGIT.  ALSO 

**       SETS  THE  MINUS  SIGN  IF  APPROPRIATE. 

** 

OUTCT   EOU     t 


LDA 

TENONE 

STA 

PORTC 

** 

LDA 

HUNDRD 

STA 

PORTA 

** 

LDA 

TENTHO 

STA 

PORTB 

*• 

BSET 

DECPT, PORTB 

BCLR 

BLANK, PORTB 

•* 

BRSET 

NEGTIV, STAT, MINUS 

BSET 

POST  IV, PORTB 

BRA 

ALLDUN 

** 

MINUS 

BCLR 

POSTIV, PORTB 

** 

ALLDUN 

RTS 

** 

** 

**  OUTPUT  POSITION  (OUTPOS). 
**       COUNT  (BCDCT)  TO  THE 
**       DISPLAYED  ,  AND  ONLY 

** 

OUTPOS  EOU     $ 

•* 

LDA 
CMP 
BLO 
LDA 
AND 
CMP 
BNE 
LDA 
CMP 
BEQ 
ADD 
BRA 


SUBROUTINE  TO  MOVE  THE  CURRENT  POSITION 
OUTPUT  PORTS.   THE  DECIMAL  POINT  IS 
THE  MOST  SIGNIFICANT  DIGIT  IS  BLANKED. 


THOUTH 

#5 

TRUNC 

HUNDTH 

#9 

#9 

DECIMAL 

HUNDTH 

#$99 

UGLY 

#7 

PCOUT 


UGLY 


LDA     #00 
STA     PORTC 
SEC 


IF  5  >  »THOUTH'  SIMPLY  TRUNCATE  THE 
DISPLAY.   OTHERWISE... 
IF  THE  LAST  DIGIT  ISN'T  A  NINE  IT  IS 
EASY  TO  ROUND  UP.   JUST  ADD  A  ONE. 

BUT  IF  THE  LAST  DIGIT  IS  A  NINE  CHECK  TO 
SEE  IF  IT'S  99.   IF  SO  IT  GETS  GRIM. 

IF  THE  NUMBER  IS  X9  AND  X  .NE.  9,  THEN 

JUST  ADD  SEVEN  TO  ROUND  UP.  DUE  TO 

HEXIDECIMAL. 

IF  THE  LOW  TWO  DIGITS  ARE  BOTH  NINES 

AND  WE  NEED  TO  ROUND  UP 

MAKE  THE  LOW  TWO  DIGITS  BOTH  ZEROS 
AND  SET  THE  CARRY. 
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986 
987 
988 
989 

990 

991 

992 

993 

994 

995 

996 

997 

998 

999 

1000 

1001 

1002 

1003 

1004 

1005 

1006 

1007 

1008 

1009 

1010 

1011 

1012 

1013 

1014 

1015 

1016 

1017 

1018 

1019 

1020 

1021 

1022 

1023 

1024 

1025 

1026 

1027 

1028 

1029 

1030 

1031 

1032 

1033 

1034 

1035 

1036 

1037 

1038 

1039 

1040 

1041 


0385 
0387 
0389 
038B 
0380 
038F 
0391 
0393 
0395 

0397 
0399 
0398 
039C 

039E 
03A0 

03A2 
03A4 

03A6 
03A8 
03AA 

03AB 

03AD 
03  A  F 

03B1 
03B3 
03B5 

03B7 
03B9 
03BB 


03BE 
03C3 
03C8 
03CD 
0302 
0307 
03OC 
03E1 
03E6 
03EB 
03F0 
03F5 
03FA 
03FF 
0404 
0409 
040E 
0413 
0418 
041D 


B6  1B 
A4  09 
A1  09 

26  1E 
B6  1B 
A1  99 

27  04 
AB  07 
20  18 

A6  00 
B7  00 
99 

20  13 

B6  1C 
AB  01 

B7  02 
20  05 

B6  1C 
B7  02 
98 

B6  1B 
A9  00 
B7  00 

B6  1A 
A9  00 
B7  01 

1C  01 
18  01 
1F  01 


03B0   81 


00  01 
05  06 
10  11 
15  16 
20  21 
25  26 
30  31 
35  36 
40  41 
45  46 
50  51 
55  56 
60  61 
65  66 
70  71 
75  76 
80  81 
85  86 
90  91 
95  96 


02  03  04 
07  08  09 
12  13  14 
17  18  19 
22  23  24 
27  28  29 
32  33  34 
37  38  39 
42  43  44 
47  48  49 
52  53  54 
57  58  59 
62  63  64 
67  68  69 
72  73  74 
77  78  79 
82  83  84 
87  88  89 
92  93  94 
97  98  99 


LDA 

ONEDEG  -- 

AND 

#9 

CMP 

#9 

BNE 

NEXT 

LDA 

ONEDEG 

CMP 

#$99 

BEO 

RLUGLY 

ADD 

#7 

BRA 

PAOUT 

** 

RLUGLY 

LDA 

#00 

STA 

PORTA 

SEC 

- 

BRA 

NEXT1 

#* 

DECIMAL 

LDA 

HUNDTH  -- 

ADD 

#1 

** 

STA 

PORTC 

BRA 

NEXT 

** 

TRUNC 

LDA 

HUNDTH  -- 

PCOUT 

STA 

PORTC 

CLC 

-- 

»* 

NEXT 

LDA 

ONEDEG 

ADC 

#0 

PAOUT 

STA 

PORTA 

•* 

NEXT1 

LDA 

HUNDEG 

ADC 

#0 

STA 

PORTB 

** 

BSET 

POST  IV, PORTS 

BSET 

BLANK, PORTB 

BCLR 

DECPT, PORTB 

CHECK  THE  LAST  DIGIT  AS  BEFORE. 

IF  USING  THIS  PORTION  OF  THE  CODE 

THERE  HAD  TO  BE  A  CARRY. 

IF  THE  LAST  DIGIT  IS  NOT  A  NINE  USE  THE 

ADC  INSTRUCTION  BELOW. 

IF  IT  IS  A  NINE,  IS  THE  NEXT  ONE  A  NINE 

ALSO? 

IF  NOT  JUST  ADD  SEVEN, 

AND  DISPLAY  THE  OUTPUT. 


IF  SO  ROUND  UP  THE  MOST  SIGNIFICANT 
DIGIT  AND  SET  EVERYTHING  ELSE  TO  ZERO. 


THIS  IS  ALL  THAT  NEEDS  TO  BE  DONE  IF 
THE  LAST  DIGIT  IS  NOT  A  NINE. 


AND  IF  THERE  IS  NO  CARRY  IT'S  EVEN  EASIER. 


RTS 


**  SET  UP  THE  TABLE  TO  BE  USED  WITH  BCD  INCREMENT/DECREMENT  ROUTINES. 


*  ENDS 

*  DATA 
TABLE   FCB 

FCB 

FCB 

FCB 

FCB 

FCB 

FCB 

FCB 

FCB 

FCB 


$00 , SO 1 , $02 , $03 , $04 , $05 , $06 , $07 , $08 , S09 
$10, $11, $12, $13, $14, $15, $16, $17, $18, $19 
$20, $21, $22, $23, $24, $25, $26, $27, $28, $29 
$30, $31, $32, $33, $34, $35, $36, $37, $38, $39 
$40 , $4 1 , $42 , $43 , $44 , $45 , $46 , $47 , $48 , $49 
$50, $51, $52, $53, $54, $55, $56, $57, $58, $59 
$60, $61, $62, $63, $64, $65, $66, $67, $68, $69 
$70, $71, $72, $73, $74, $75, $76, $77, $78, $79 
$80 , $8 1 , $82 , $83 , $84 , $85 , $86 , $87 , $88 , $89 
$90 , $91 , $92 , $93 , $94 , $95 , $96 , $97, $98 , $99 
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1042 

1043 

1044 

1045 

1046 

1047 

1048 

0422 

1049 

1050 

1051 

0F38 

1052 

0F38 

07 

1053 

1054 

1055 

1056 

1057 

1058 

1059 

1060 

1061 

1062 

1063 

1064 

1065 

1066 

1067 

1068 

1069 

0FF8 

1070 

1071 

0FF8 

01 2E 

1072 

OF  FA 

014D 

1073 

OFFC 

014D 

1074 

OFFE 

0080 

1075 

1076 

1077 

1078 

1079 

1000 

ENDS 
CODE 

SET  UP  MASK  OPTION  REGISTER. 


*****  ************** 


ABSOLUTE 

ORG 

NOR 

FCB 

#BIT2*BIT1+BIT0 

COMMENTS: 

BIT  7 

CLOCK  SOURCE     0  *  CRYSTAL. 

BIT  6 

TIMER  OPTION     0  ■   INTERNAL. 

BIT  5 

TIMER/CLOCK  SOURCE     0  ■   INTERNAL. 

BIT  4 

NOT  USED. 

BIT  3 

NOT  USED. 

BIT  2 

SET     - 

BIT  1 

SET          -     PRESCALE  SELECT     111   =>  128 

BIT  0 

SET     - 

•♦••♦I******************************************************************* 


ASSIGN  INTERRUPT  VECTORS. 


«* 
*» 


ORG 

FDB 
FDB 
FDB 
FDB 


ENDS 
END 


INTRPT 

BLINK  TIMER/INT2  INTERRUPT  VECTOR. 

COUNT  EXTERNAL  INTERRUPT  VECTOR. 

COUNT  SOFTWARE  INTERRUPT  VECTOR,  NOT  USED. 

RESTRT  RESET  VECTOR. 


Lines  Assembled 


1079 


Assembly  Errors  :  0 
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** 


**  I/O  REGISTER  ADDRESSES 

•• 

PORTA 

EOU 

$0000 

I/O  PORT  A 

PORTB 

EOU 

$0001 

I/O  PORT  B 

PORTC 

EOU 

$0002 

I/O  PORT  C 

PORTD 

EOU 

$0003 

INPUT  PORT 

*• 

C.  TILT 


1  TTL  POSITION  DETERMINING  PROGRAM  (ELEVATION) 

2  »  LATEST  REVISION  9  MAY  89 

3  *  FILE  NAME  TILT. ASM 

4  ** 

5  **  PROGRAM  DESCRIPTION 
6 
7 
8 
9 

10 

11  0000 

12  0001 

13  0002 

14  0003 
15 

16  **  DATA  DIRECTION  REGISTER  OFFSET 

17  ** 

18  0004  DOR     EOU     4       (eg.  DDR  FOR  PORT  A  IS  PORTA+DDR  ) 

19  ** 
20 
21 

22  0008  TIMER   EOU     $0008   EIGHT  BIT  TIMER  REGISTER. 

23  0009  TCR     EOU     $0009   TIMER  CONTROL  REGISTER. 

24  000A  MR      EOU     S000A   MISCELLANEOUS  REGISTER. 

25  0010  RAM     EOU     $0010   START  OF  ON-CHIP  RAM(112  -  31  FOR  STACK) 

26  0080  ZROM    EOU     $0080   PAGE  ZERO  OF  ROM. 

27  0100  ROM     EOU     $0100   START  OF  MAIN  ROM. 

28  0F38  MOR     EOU     $0F38   MASK  OPTION  REGISTER. 

29  0FF8  INTRPT  EOU     $0FF8   LOCATION  OF  INTERRUPT  VECTORS. 

30  1000  MEMSIZ  EOU     $1000   MEMORY  ADDRESS  SIZE. 
31 
32 
33 

34  0001 

35  0002 

36  0004 

37  0008 

38  0010 

39  0020 

40  0040 

41  0080 
42 

43  0000 

44  0001 

45  0002 

46  0003 

47  0004 

48  0005 

49  0006 

50  0007 
51 
52 
53 
54 

55  0007  TIR     EOU     7       TIMER  INTERRUPT  REOUEST.  1  =  REQUEST,  0  =  NO  REQ. 

56  0006  TIM     EOU     6       TIMER  INTERRUPT  MASK.  1  =  DISABLED,  0  =  ENABLED. 

57  0005  TIN     EOU     5       EXTERNAL  OR  INTERNAL  CLOCK  SOURCE.  1  =.  EXT,  0  =  INT. 

58  0004  TEE     EOU     4       EXTERNAL  CLOCK  ENABLE.  NOT  USED. 

59  0003  PSC     EOU     3       PRESCALER  CLEAR.  NOT  USED. 

60  0002  PS2     EOU     2      (PS2) 

61  0001  PS1     EOU     1       (PS1)        PRESCALER  SELECT  BITS. 
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**  OTHERS 

*• 

TIMER 

ECU 

$0008 

TCR 

EOU 

$0009 

MR 

EOU 

$000A 

RAM 

EOU 

$0010 

ZROM 

EOU 

$0080 

ROM 

EOU 

$0100 

MOR 

EOU 

$0F38 

INTRPT 

EOU 

$0FF8 

MEMSIZ 

EOU 

$1000 

** 

**  EQUATES 

*# 

BITO 

EOU 

1 

BIT1 

EOU 

2 

BIT2 

EOU 

4 

B1T3 

EOU 

8 

BIT4 

EOU 

16 

BIT5 

EOU 

32 

BIT6 

EOU 

64 

BIT7 

EOU 

128 

** 

BO 

EOU 

0 

B1 

EOU 

1 

B2 

EOU 

2 

B3 

EOU 

3 

B4 

EOU 

4 

B5 

EOU 

5 

B6 

EOU 

6 

B7 

EOU 

7 

** 

**  EOUATES  FOR 

THE  Tl> 

** 

*** 

TIR 

EOU 

7 

TIM 

EOU 

6 

TIN 

EOU 

5 

TEE 

EOU 

4 

PSC 

EOU 

3 

PS2 

EOU 

2 

PS1 

EOU 

1 

62  0000  PSO     EQU     0      (PSO)  -- 

63  ** 

64  **  EQUATES  FOR  THE  STATUS  BYTE,  'STAT'. 

65  *** 

66  •** 

67  ** 

68  0007  UD      EQU     7      COUNT  DIRECTION?   1  =  UP,  0  =  DOWN. 

69  0006  MOO  32  EQU     6       IS  'BINCT'  MODULO  32?   1  ■  YES,  0  ■  NO. 

70  0005  FLASH   EQU     5       BLINK  THE  DISPLAY?  1  ■  YES,  0  *  NO. 

71  0004  POSCT   EQU     4      DISPLAY  POSITION  OR  COUNT?  1  *  POS,  0  ■  COUNT. 


89 

90 


UD 

EQU 

7 

MOO  32 

EQU 

6 

FLASH 

EQU 

5 

POSCT 

EQU 

4 

L  SET 

EQU 

3 

NEGTIV 

EQU 

2 

**» 

1 

»»* 

0 

72  0003  L  SET   EQU     3      VALUE  OF  'MODE, PORTO'  LAST  TIME. 

73  0002  NEGTIV  EQU     2       IS  »BCDCT' NEGATIVE  NUMBER?   1  ■  YES,  0  *  NO. 

74  ***  1      NOT  USED. 

75  ***  0      NOT  USED. 

76  •** 

77  ... 

78  "  I/O  EQUATES  ANO  DESCRIPTIONS. 

79  *** 

80  *** 

81  ***  PORT  A  (I/O) 

82  *** 

83  ***    + ♦ ♦ + ♦ ♦ -♦ ♦ ♦ 

84  ***  |         BCD  DIGIT  #4         |        BCD  DIGIT  #3         | 

85  ***    + + ♦ + + ♦ ♦ + ♦ 

86  ***  |   D4   |   C4   |   B4   |   A4   |   D3   |   C3   |   B3   |   A3   | 

87  ***     ♦ ♦ ♦ + +  -- ♦- + ♦ ♦ 

88  ***  BIT  7      6      5     4      3      2      1      0 

... 

*** 

91  ***  PORT  B  (I/O) 

92  *** 

93  ***    ♦ + ♦ + + + + •♦.......+ 

94  ***  |        DISPLAY  CONTROL        |          NOT  USED           | 

95  ***     ♦ -+-- ♦ +-- ♦ + ♦ ♦ ♦ 

96  ***  |  DECPT  |  POSTIV|       |  BLANK  |       |       |       |       | 

97  ***    + ♦- + --+ + + ♦ ♦ ♦ 

98  ***  BIT  7      6      5     4      3      2      1      0 

99  *** 

100  0007  DECPT   EQU     7      TO  DISPLAY  THE  DECIMAL  POINT. . .DECPT  IS  CLEARED 

101  0006  POSTIV  EQU     6      USED  TO  DISPLAY  NEGATIVE  SIGN. . .CLEARED  TO  SHOW 

102  ***  MINUS  SIGN. 

103  0004  BLANK   EQU     A       TO  BLANK  DIGITS  2  AND  3. . .CLEAR  BLANK. 

104  ***  DIGITS  4  AND  5  ARE  ALWAYS  BLANKED. 

105  ***  DIGIT  1  IS  NEVER  BLANKED. 

106  *** 

107  ***  PORT  C  (I/O) 

108  *** 

109  ***     + + ♦ + •+ + --+ + ♦ 

110  ***  |         BCD  DIGIT  #2         | BCD  DIGIT  #1(LEAST  SIGNIFICANT)! 

111  ***     + + + + + + ♦ --♦ •♦■ 

112  ***  |   D2   |   C2   |   B2   |   A2   |   D1   |   C1   |   B1   |   A1   | 

113  ***    + + + ♦ ♦ + ♦ -+ ♦ 

114  ***  BIT  7      6      5     4      3      2      1      0 

115  *** 

116  *** 

117  ***  PORT  D   (INPUT  ONLY) 

118  *** 

119  ***     + ♦ ♦ + + ♦ ♦ + + 

120  ***  |  CH_A   |   INT2  |   CH_B  |  FUNCT  |   SET   |       |       |       | 

121  ***    +-- ♦ ♦ ♦ + ♦ + ♦ ♦ 

122  ***  BIT  7      6      5     4      3      2      1      0 

123  *** 

124  0007  CH_A    EQU     7       INDICATES  THE  STATUS  OF  CHANNEL  A. 

125  0006  INT2    EQU     6       INTERRUPT  #2.  USED  TO  CHANGE  DISPLAY  MODES. 

126  0005  CH_B    EQU     5       INDICATES  THE  STATUS  OF  CHANNEL  B. 

127  00W  FUNCT   EQU     4       USED  TO  PUT  THE  PROGRAM  IN  A  MODE  THAT  WILL  ALLOW 
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128 
129 
130 
131 
132 
133 
134 
135 
136 
137 
138 
139 
HO 
141 
142 
143 
144 
145 
146 
147 
148 
149 
150 
151 
152 
153 
154 
155 
156 
157 
158 
159 
160 
161 
162 
163 
164 
165 
166 
167 
168 
169 
170 
171 
172 
173 
174 
175 
176 
177 
178 
179 
180 
181 
182 
183 
184 
185 
186 
187 
188 
189 
190 
191 
192 
193 


0003 


SET 


EOU 


»HYST'  TO  BE  INCREMENTED. 

INCREMENTS  'HYST'  WHEN  TOGGLED  AND  FUNCT  IS  LOU. 


** 
** 

Ml 
«tt««««»<Ht»*ttmi*ti>»«»«tt»««*i»tt>t*« 


RAM  VARIABLES 


►»****»»*»**»*»****»***»» 


0000 


0000 


0010 


0010 


0012 


RESERVE  MEMORY  SPACE  FOR  THE  PROGRAM  VARIABLES. 
DATA 

ABSOLUTE  (ABSOLUTE  ADDRESSING  USED  HERE  TO  RELATIVE  DIRECTIVE) 


ORG 


RAM 


0015 


0017 


0010 
0011 


0012 
0013 
0014 


0015 
0016 


0017 
0018 
0019 


** 

***  BINARY  COUNT. 

BINCT   RMB     2 

HIBIN   EOU     BINCT 

LOBIN   EOU     BINCT+1 

*• 

***  POSITION  POINTERS. 
PTR     RMB     3 


PTR3 

EOU 

PTR 

PTR2 

EOU 

PTR+1 

PTR1 

EQU 

PTR+2 

** 

***  COUNT  POINTERS. 
CTPTR   RMB     2 


START  OF  RAM. 


HI  BYTE. 
LO  BYTE. 


EACH  BYTE  POINTS  TO  A  POSITION  IN  THE 
TABLE  THAT  CONTAINS  ONE  OR  TWO  DIGITS 
OF  THE  BCD  POSITION. 
MOST  SIGNIFICANT  DIGITS. 

LEAST  SIGNIFICANT  DIGIT. 


EACH  BYTE  POINTS  TO  A  POSITION  IN  THE 
TABLE  THAT  CONTAINS  TWO  OF  THE  DIGITS 
IN  THE  BCD  COUNT. 


001A 


001A 
001B 


CTPTR2 

CTPTR1 

»* 

EOU 
EOU 

CTPTR 
CTPTR+1 

MOST  SIGNIFICANT 
LEAST  SIGNIFICAN1 

DIGITS. 
'  DIGITS. 

***  BCD 

DEGRES 

ONEDEG 

HUNDTH 

THOUTH 

*** 

POSITION  IN  DEGRI 
RMB     3 
EOU     DEGRES 
EOU     DEGRES+1 
EOU     DEGRES+2 

EES. 

CONTENTS 

CONTENTS 

+  CONTENTS 

X 
X 
X 

1.000 
0.010 
0.001 

** 

POSITION 

IN 

DEGREES 

***  BCD 

BCDCT 
HUNDRD 

TENONE 

*»» 

COUNT. 
RMB 
EQU 
EQU 

2 

BCDCT 
BCDCT+1 

CONTENTS 
♦  CONTENTS 

X 
X 

100 

1 

»»« 

NUMBFR  OF  Pt 

II  <?F 

:§  COUNTED 

001  c 


*** 

***  HYSTERESIS  COUNTER.  POINTS  TO  A  NUMBER  IN  THE  TABLE  THAT  IS  THE 
***      AMOUNT  OF  HYSTERESIS  PRESENT  IN  THE  SYSTEM.   INITIALIZED  TO  6. 

HYSTPT  RMB      1 

** 

***  POSITION  INCREMENT.   CONTAINS  A  NUMBER,  THAT  WHEN  MULTIPLIED  BY  0.001 
***      IS  THE  NUMBER  OF  DEGREES  THAT  THE  POSITION  COUNTER  (BCDPOS)  IS 
***      TO  BE  INCREMENTED  OR  DECREMENTED  DURING  PROGRAM  EXECUTION. 
***      THE  VALUE  OF  'POSINC,  DETERMINED  EXPERIMENTALLY,  SHOULD  BE 
***      7.0452.   SINCE  THE  PROGRAM  IS  DESIGNED  WORK  WITH  INTEGERS  ONLY 
***      THIS  NUMBER  IS  ROUNDED  TO  7.   TO  REDUCE  THE  CUMULATIVE  EFFECT  OF 
***      THE  ROUND  OFF,  EVERY  32  COUNTS  »POSINC  IS  SET  EQUAL  TO  8.   THIS 
***      AGAIN  LEADS  TO  SOME  CUMULATIVE  ERROR,  BUT  THE  SMALL  ANGULAR  RANGE 
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194 
195 
196 
197 
198 
199 
200 
201 
202 
203 
204 
205 
206 
207 
208 
209 
210 
211 
212 
213 
214 
215 
216 
217 
218 
219 
220 
221 
222 
223 
224 
225 
226 
227 
228 
229 
230 
231 
232 
233 
234 
235 
236 
237 
238 
239 
240 
241 
242 
243 
244 
245 
246 
247 
248 
249 
250 
251 
252 
253 
254 
255 
256 
257 
258 
259 


001D 

001E 
001 F 


0020 
0021 


***      OF  THE  TILT  ANGLE  (10.5  DEGREES)  ALLOWS  US  TO  NEGLECT  ANY  FURTHER 
***      MODIFICATIONS. 

MM 

POSINC  RMB     1 
*** 

***  HYSTERESIS  VARIABLES.  USED  TO  ELIMINATE  THE  EFFECTS  OF  BACKLASH  ON 
***      THE  POSITION  MEASUREMENTS. 

*** 

HYST    RMB     1       THE  THRESHHOLD  VALUE  DETERMINED 

***  EXPERIMENTALLY. 

HYSTCT  RMB     1       CURRENT  AMOUNT  OF  HYSTERESIS  MEASURED. 

MM 

***  STATUS  BYTE.  USED  TO  KEEP  TRACK  OF  WHAT  IS  GOING  ON. 

MM 

CURRENT  STATUS. 

PREVIOUS/LAST  STATUS.  USED  TO  KEEP  TRACK  OF 

L_SET  ONLY. 

MM 

***  TIMER  COUNTER.  USED  IN  CONJUNCTION  WITH  THE  TIMER  PRESCALER  AND  THE 
***      TDR  TO  KEEP  TRACK  OF  ONE  SEC.  INTERVALS.  USED  IN  BLINKING  THE 
***      DISPLAY.   INITIALLY  SET  TO  31,  WHEN  THE  'FLASH'  BIT  OF  'STAT' 
***      IS  SET.   TIMCT  IS  DECREMENTED  EACH  CLOCK  INTERRUPT  (APPROX.  31 
***      TIMES  PER  SEC).  RESET  TO  31  WHEN  CONTENTS  GO  TO  ZERO. 

***      WHEN  (TIMCT)=0  THE  DISPLAY  WILL  TOGGLE. 
*** 


STAT 

RMB 

1 

LSTAT 

RMB 

1 

*** 

0022 


TIMCT 

** 


RMB 


ENDS 


1 


** 
*** 

************************************************************************ 
•*  * 

** 


PAGE  ZERO  ROM 


*« 

** 
** 
*• 


0000 
0080 
0080 


CODE 

ORG 

RELATIVE 


ZROM 


INITIALIZATION  ROUTINE. 

PAGE  ZERO  ROM. 

RELATIVE  ADDRESSING  MUST  BE  USED  FOR  THE  BRANCH. 


*• 


0080 


RESTRT  EQU 

MM 


0080 
0081 

0082 
0084 
0085 
0086 
0088 


008A 


9B 
9C 

AE  10 
7F 
5C 

A3  22 
23  FA 


$       THIS  IS  THE  ENTRY  POINT  WHEN  AN  EXTERNAL 
INTTERRUPT  OCCURS. 

*• 
************************************************************************ 

** 

***  INITIALIZE  THE  PC  AND  CLEAR  RAM. 

*** 

*** 

SEI  SET  INTERUPT  TO  AVOID  INTERUPTION  AND 

RSP  RESET  THE  STACK  POINTER.  JUST  IN  CASE! 

*** 

LDX     «BINCT  CLEAR  ALL  OF  THE  VARIABLES  BETWEEN 
CLR     ,X      'BINCT'  AND  'TIMCT'  (INCLUSIVE). NOTE 
INCX  THAT  THIS  SETS  THE  COUNTER  AND  THE  POS- 

CPX     #TIMCT   ITION  TO  ZERO.  THIS  MEANS  THAT  ROTATION 
BLS     CLRIT   SHOULD  START  IN  AN  INCREASING  (CW 

DIRECTION  FROM  THE  MOST  CCW  POSHiON 

AFTER  A  RESET. 

ABSOLUTE       BACK  TO  ABSOLUTE  ADDRESSING. 


CLRIT 


*•* 

MM 

*** 
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260 

261 

*•* 

262 

*** 

ESTABLISH  I/O  PORTS. 

263 

MM 

264 

008A 

A6  FF 

LDA 

#•1        PORTS  A,B,C  ARE  CONFIGURED  AS 

265 

008C 

B7  04 

STA 

PORTA+DDR   ALL  OUTPUT.  PORT  D  IS  ALL  INPUT 

266 

008E 

B7  05 

STA 

PORTB+DDR   SO  THERE  IS  NO  MASK  TO  SET. 

267 

0090 

B7  06 

STA 

PORTC+ODR 

268 

MM 

269 

*************i 

MMMMMMMMMMMMMMMMMMMMMMMMMMMMMMMMMMMMMMM 

270 

MM 

SET  UP  THE  STATUS  REGISTER. 

271 

MM 

272 

0092 

A6  08 

LDA 

M00001000   -- 

273 

0094 

B4  03 

AND 

PORTD         |-->  SET  UP  'L  SET'  BIT  OF  'STAT'. 

274 

0096 

B7  20 

STA 

STAT 

275 

MM 

276 

0098 

1C  20 

BSET 

M00_32,STAT  0  IS  MODULO  32. 

277 

** 

278 

279 

MM 

280 

MM 

INITIALIZE  HYSTCT. 

281 

MM 

282 

009A 

A6  06 

LDA 

#06 

283 

009C 

B7  1E 

STA 

HYST 

284 

009E 

B7  1C 

STA 

HYSTPT 

285 

MM 

286 

•♦A********************************************************************* 

287 

** 

288 

** 

SET 

UP  THE  TIMER  FOR  A  4  MHZ  CRYSTAL  /  4  =  1  MHZ  CLOCK. 

289 

MM 

290 

*** 

NOTE: 

THE  MASK  OPTION  REGISTER  IS  IN  ROM.   IT  IS  SET  UP  AT 

291 

MM 

THE  END  OF  THE  PROGRAM. 

292 

*** 

293 

294 

*** 

295 

00A0 

A6  47 

LDA 

#BIT6+BIT2*BIT1+BIT0 

296 

MM 

(TIM)|(PS2)(PS1)(PS0) 

297 

•"(DISABLE  INTERRUPT)  |    SCALE  BY  128) 

298 

MM 

299 

00A2 

B7  09 

STA 

TCR 

300 

MM 

301 

*»* 

302 

MM 

SET  UP  THE  TIMER. 

303 

*** 

304 

00A4 

A6  FF 

LDA 

#255    1  MHZ/(128*255)  =  30.6  (APPR0X.  31) 

305 

00A6 

B7  08 

STA  TIMER 

306 

*** 

307 

****************      IALIZ           COUNTER.  *********************** 

308 

MM 

309 

00A8 

A6  1F 

LDA 

#31     PROVIDES  FOR  1  SEC.  BLINK  INTERVAL. 

310 

OOAA 

B7  22 

STA 

TIMCT   FOR  2  SEC.  INTERVAL  JUST  USE  TIMECT=62,  etc. 

311 

*** 

312 
313 

MM 

314 

** 

315 

** 

SET  UP  MISCELLANEOUS  REGISTER. 

316 

** 

317 

OOAC 

1D  OA 

BCLR 

B6.MR    ENABLES  THE  SECOND  INTERRUPT. 

318 

** 

319 

A*********************************************************************** 

320 

** 

321 

** 

COUNT  =  0  IS  DISPLAYED  INITIALLY. 

322 

** 

323 

OOAE 

CO  02  D8 

JSR 

OUTCT 

324 

00B1 

1C  01 

BSET 

POSTIV.PORTB 

325 

** 
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326 

327 

00B3 

9A 

328 

329 

00B4 

330 

331 

332 

333 

334 

335 

336 

0084 

09  0 

337 

338 

00B7 

06  03  04 

339 

00BA 

17  20 

340 

OOBC 

20 

F6 

341 

OOBE 

16 

20 

342 

OOCO 

20 

F2 

343 

344 

345 

346 

347 

348 

349 

00C2 

A6 

40 

350 

00C4 

B7 

09 

351 

352 

00C6 

A6 

08 

353 

00C8 

B4 

20 

354 

OOCA 

B7 

21 

355 

OOCC 

A6 

08 

356 

OOCE 

B4 

03 

357 

0000 

B1 

21 

358 

0002 

27 

15 

359 

360 

0004 

A6 

08 

361 

0006 

B8 

20 

362 

0008 

B7 

20 

363 

OOOA 

3C 

1E 

364 

oooc 

3C 

1C 

365 

366 

0OOE 

B6 

1C 

367 

OOEO 

A1 

19 

368 

00E2 

23 

05 

369 

370 

00E4 

4F 

371 

00E5 

B7 

1E 

372 

00E7 

B7 

1C 

373 

374 

00E9 

A6 

00 

375 

OOEB 

B7 

00 

376 

OOED 

A6 

CO 

377 

OOEF 

B7  01 

378 

379 

00F1 

BE 

1C 

380 

00F3 

D6 

03  28 

381 

00F6 

B7 

02 

382 

383 

00F8 

09 

03  C7 

384 

OOFB 

04 

20  04 

385 

OOFE 

1C 

01 

386 

0100 

20 

02 

387 

0102 

1D 

01 

388 

0104 

08 

20  05 

389 

390 

0107 

CD 

02  D8 

391 

01 OA 

20 

03 

CLI 
RELATIVE 


CLEAR  THE  INTERRUPT  MASK  TO  GET  STARTED. 

RELATIVE  ADDRESSING  MUST  BE  USED  FOR  THE 
REMAINDER  OF  THE  PROGRAM. 


»».»»**»»»#»* 


**  WAIT  LOOP.  EXECUTES,  UNTIL  AN  INTERRUPT  OCCURS. 

** 

PAUSE   BRCLR  FUNCT , PORTD , CHHYST  UANT  TO  CHANGE  HYST? 

**  YES... GO  TO  CHHYST. 

BRSET  SET, PORTD, SB IT  NO.. .' SET, PORTO'  SET? 

BCLR  L  SET, STAT  NO... CLEAR  »L  SET, STAT' 

BRA  PAUSE  AND  LOOP. 

SBIT    BSET  L  SET, STAT  YES... SET  'L  SET, STAT' 

BRA  PAUSE  AND  LOOP. 


**  HYSTERESIS 
**  HYSTERESIS 

M 

CHHYST  LDA 
STA 
**• 

LDA 
AND 
STA 
LDA 
AND 
CMP 

BEO 

»** 

LDA 
EOR 

STA 
INC 

INC 

••• 

LDA 
CMP 

BLS 

*** 

CLRA 

STA 

STA 

*** 

DISPLA  LDA 

STA 

LDA 

STA 
*** 

LDX 
LDA 
STA 


BRCLR 

BRSET 

BSET 

BRA 

BCLR 

BRSET 


MODIFICATION  ROUTINE.  PERMITS  MODIFICATION  OF  THE 
BUFFER  WITHOUT  REPROGRAMMING. 

YES... 

DISABLE  TIMER  INTERRUPT. 


SIGN 
DIR 


#8IT6 
TCR 

#%00001000 

STAT 

LSTAT 

«00001000 

PORTD 

LSTAT 

DISPLA 

trxooooiooo 

STAT 
STAT 
HYST 
HYSTPT 

HYSTPT 

#25 

DISPLA 


SAVE  'L  SET' 

INTO 

' LSTAT'. 

'SET, PORTD'  -->  ACCUMULATOR 

HAS  THE  SET  SWITCH  BEEN  CHANGED? 

YES... 

|-->CHANGE  'L_SET,STAT\ 

THEN  INCREMENT  THE  HYSTERESIS 
POINTER  AND  'HYST'... 


BUT  NOT  ABOVE  25. 
THEN---> 


NO. 


JUST- 


-  DISPLAY  CURRENT  'HYST' 


JSR 
BRA 


HYST 
HYSTPT 

noooooooo 

PORTA 

m 1000000 

PORTS 

HYSTPT 
TABLE, X 
PORTC 

IS  'HYST'  SETTING  COMPLETE? 
FUNCT, PORTD, CHHYST  NC...  KEEP  CHECKING  'SET'. 
NEGTIV, STAT, SIGN   YES...  RESET  THE  DISPLAY. 
POSTIV,PORTB 
DIR 

POSTIV.PORTB 
POSCT,STAT,SH0P0S 

OUTCT 
DUNCHG 
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392 

393 

01 OC 

CD  02 

E5 

394 

395 

010F 

OB  20 

04 

396 

0112 

A6  07 

397 

0114 

B7  09 

398 

0116 

20  9C 

399 

400 

401 

402 

403 

404 

405 

406 

407 

408 

409 

410 

411 

412 

413 

414 

415 

416 

417 

418 

419 

0118 

1F  OA 

420 

421 

011A 

OA  20 

10 

422 

011D 

09  20 

07 

423 

0120 

1A  20 

424 

425 

0122 

A6  07 

426 

0124 

B7  09 

427 

0126 

80 

428 

429 

0127 

18  20 

430 

0129 

CD  02 

E5 

431 

012C 

80 

432 

433 

01 2D 

A6  47 

434 

012F 

B7  09 

435 

0131 

19  20 

436 

0133 

1B  20 

437 

438 

0135 

CD  02 

D8 

439 

0138 

80 

440 

441 

442 

443 

444 

445 

446 

447 

448 

449 

0139 

450 

0139 

OF  09 

DC 

451 

452 

453 

013C 

1F  09 

454 

455 

013E 

3A  22 

456 

0140 

27  01 

457 

SHOPOS 

JSR 

OUTPOS 

••* 

DUNCHG 

BRCLR 

FLASH, ST AT, NO  INT 

LDA 

0BIT2+BITHBITO 

STA 

TCR 

NO  INT 

BRA 

PAUSE 

IF  THE  DISPLAY  IS  TO  BLINK... 
ENABLE  TIMER  INTERRUPT  AND  RESET 
TIMER  PRESCALER 
PRIOR  TO  RETURNING. 


**  MAXIMUM  EXECUTION  TIME  FOR  THE  REMAINDER  OF  THE  PROGRAM  OCCURS 

**  IF  THE  COUNTER  ROTATES  THROUGH  ZERO  AS  THE  DISPLAY  MODE  IS  CHANGED 

**  FROM  THE  BLINKING  MODE  TO  THE  COUNT  MODE  AT  THE  SAME  TIME  THAT  THE 

**  BLINKING  ROUTINE  IS  CAUSING  THE  DISPLAY  TO  TOGGLE  TO  SHOW  THE 

"  POSITION  IN  DEGREES. 

**     MAXIMUM  EXECUTION  TIME  =  67  +  140  +  618  =  825  CLOCK  CYCLES. 

** 

** 

"MODE  CHANGE  ROUTINE.   CHANGES  THE  DISPLAY  MODE  FROM 

**       COUNT  ->  POSITION  ->  BLINKING  ->  COUNT  -> (ETC.) 

**       MAXIMUM  EXECUTION  TIME  OF  127  CLOCK  CYCLES  OCCURS  WHEN  THE 

**       DISPLAY  MODE  IS  CHANGED  FROM  DISPLAYING  THE  COUNT  TO  DISPLAYING 

**       THE  POSITION  (IN  DEGREES). 

IF  THE  DISPLAY  IS  CHANGED  FROM  BLINKING  TO  A  COUNT  DISPLAY 

EXECUTION  TIME  IS  67  CLOCK  CYCLES. 


*» 
** 
** 


CHMODE 

** 


BCLR    B7.MR 


DISPOS 


DIS  CT 


BRSET 
BRCLR 
BSET 

LDA 
STA 
RTI 

BSET 

JSR 

RTI 

LDA 
STA 
BCLR 
BCLR 

JSR 
RTI 


FLASH, STAT, D I S_CT 
POSCT, STAT, DISPOS 
FLASH, STAT 

#BIT2*BIT1+BIT0 
TCR 


POSCT, STAT 
OUTPOS 


AVOID  REPEATED  INTERRUPTS. 

IF  FLASHING,  DISPLAY  COUNT... 

IF  SHOWING  COUNT,  DISPLAY  POSITION. 

ELSE,  BLINK. 

ENABLE  TIMER  INTERRUPT  AND  RESET 
TIMER  PRESCALER. 


|"  DISPLAY  CURRENT  POSITION,  AND  WAIT. 


#BIT6+BIT2+BIT1+BIT0 

TCR 

POSCT, STAT 

FLASH, STAT        | 

I" 
OUTCT 


DISABLE  TIMER  INTERRUPT  AND  RESET 
TIMER  PRESCALER. 


DISPLAY  CURRENT  COUNT,  AND  WAIT. 


************************************************************************ 

•• 

**  BLINK  ROUTINE.   INTERRUPT  ROUTINE  TO  CHANGE  THE  DISPLAY  FROM  POSITION 

** 

** 
** 
*» 
** 


TO  COUNT  OR  VICE  VERSA  EVERY  31  ST  TIMER  INTERRUPT  IF  THE 
'FLASH'  BIT  OF  'STAT'  IS  SET. 

MAXIMUM  EXECUTION  TIME  OF  140  CLOCK  CYCLES  OCCURS  WHEN  THE 
DISPLAY  IS  TOGGLED  FROM  A  COUNT  DISPLAY  TO  A  POSITION  DISPLAY. 


BLINK 


EQU 
BRCLR 


T I R, TCR, CHMODE 


** 
** 


BCLR    TIR.TCR 


DEC 
BEO 


TIMCT 
CHGDIS 


IF  THE  INTERRUPT  WAS  NOT  A  TIMER 
INTERRUPT  IT  MUST  BE  FROM  INT2. 

AVOID  REPEATED  TIMER  INTERRUPTS. 

IF  THERE  HAVE  BEEN  31  TIMER 
INTERRUPTS  (1  SEC),  IT'S  TIME  TO 
CHANGE  THE  DISPLAY. 


Ill 


458 

0142 

80 

459 

460 

0143 

A6  1F 

461 

0145 

B7  22 

462 

463 

0147 

B6  20 

464 

0149 

A8  10 

465 

014B 

B7  20 

466 

467 

0140 

08  20  04 

468 

469 

470 

471 

0150 

CO  02  D8 

472 

0153 

80 

473 

474 

475 

476 

0154 

CD  02  E5 

477 

0157 

80 

478 

479 

480 

481 

482 

483 

484 

485 

486 

487 

488 

489 

490 

491 

492 

493 

494 

495 

496 

497 

498 

499 

500 

501 

502 

503 

504 

505 

506 

0158 

507 

0158 

OA  03  01 

508 

015B 

80 

509 

510 

511 

512 

015C 

A6  7F 

513 

015E 

B4  20 

514 

0160 

B7  20 

515 

0162 

A6  80 

516 

0164 

B4  03 

517 

518 

0166 

BA  20 

519 

0168 

B7  20 

520 

521 

522 

523 

016A 

OE  20  09 

RTI 

** 

CHGOIS  LDA 
STA 


#31 
TIMCT 


LDA     STAT 

EOR     ttOOO 10000 
STA     STAT 


OTHERWISE,  IT'S  BACK  TO  WORK. 

RESET  TIMCT  TO  31  (1  SEC.  INTERVAL). 

|--  CHANGE  'POSCT'  BIT  OF  'STAT'. 


BRSET   POSCT, STAT, POSOUT     DECIDE  ON  CORRECT  DISPLAY. 

CHANGE  THE  DISPLAY  TO  SHOW  THE  COUNT *************** 

JSR     OUTCT 
RTI 


************     or  have  THE  DISPLAY  SHOW  THE  POSITION.     ************* 

** 

POSOUT  JSR     OUTPOS 
RTI 


***************************** 


**************** 


** 
** 


COUNT  ROUTINE. 
WHEN  A  COUNT  IS  RECEIVED  THIS  IS  THE  ENTRY  POINT  . 
MAXIMUM  EXECUTION  TIME  OF  618  CLOCK  CYCLES  OCCURS  WHEN  THE 
COUNTER  ROTATES  CCW  THROUGH  ZERO  AND  THE  POSITION  (IN  DEGREES) 
IS  BEING  DISPLAYED. 


**  CURRENT  DIRECTION  OF  ROTATION  IS  DETERMINED  BY  INSPECTING  THE  STATUS 
**  OF  'CH  A'  AND  'CH  B'.   THE  FOUR  POSSIBILITIES  AND  THE  ASSOCIATED 
**  DIRECTION  OF  ROTATION  ARE  AS  SHOWN  BELOW.   NOTE  THAT  THIS  SCHEME 
**  PREVENTS  MULTIPLE  OSCILLATIONS  ABOUT  A  SINGLE  POINT  FROM 
**  REPEATEDLY  INCREMENTING  OR  DECREMENTING  THE  COUNTER. 


** 

** 

*• 

** 

*• 

*• 

*• 

** 

** 

*• 

********  FIRST  SEE  IF  yg  ARE  SUPPOSED  TO  COUNT  THIS  INTERUPT.   ******** 

** 

COUNT   EOU     $ 

BRSET   CH  B.PORTD.OKCT 

RTI 

** 

**************   ip  THE  INTERRUPT  IS  VALID  UPDATE  'STAT 

** 

OKCT 

SAVE  ALL  OF  THE  OLD  'STAT'  EXCEPT  THE 
DIRECTION  OF  ROTATION. 

«CH_A,PORTD'  INDICATES  THE  DIRECTION 
OF  ROTATION  AND  BECOMES  'UD.STAT'. 
ADD  THE  RESULTS  TO  GET 
THE  NEW  'STAT'. 

DECIDE  IF  THE  "SLACK"  DUE  TO  BACKLASH/HYSTERESIS  HAS  BEEN  TAKEN  OUT. 

BRSET   UO.STAT.HYSTCK   IF  ROTATING  CW  SEE  BELOW. 


+ + +- + ♦ 

|   CH  A   |   CH  B   |   DIRECTION      |   COUNT  THE  PULSE?  | 
OF  ROTATION 

+  — + + + - ---♦ 

|   LO   |    LO   |      CW         |        NO        | 
LO       HI         CCW  YES 

HI        LO         CCW  NO 

HI    j    HI         CW  YES 

+ ♦ -+ + - + 


IF  CH_B  IS  LO  WE  DON'T  COUNT  THE 
INTERRUPT. 

•a************ 


LDA 

#X01111111 

AND 

STAT 

STA 

STAT 

LDA 

#X10000000 

AND 

PORTD 

ORA 

STAT 

STA 

STAT 

112 


524 

0160 

B6 

1F 

525 

016F 

27  4B 

526 

527 

0171 

A0 

01 

528 

0173 

B7 

1F 

529 

0175 

80 

530 

531 

0176 

B6 

1E 

532 

0178 

B1 

1F 

533 

01 7k 

27  03 

534 

01 7C 

3C 

1F 

535 

017E 

80 

536 

537 

538 

539 

540 

541 

542 

01 7F 

543 

544 

545 

546 

547 

01 7F 

B6 

11 

548 

0181 

AB 

01 

549 

0183 

B7 

11 

550 

551 

0185 

B6 

10 

552 

0187 

A9 

00 

553 

0189 

B7 

10 

554 

555 

556 

557 

558 

018B 

B6 

11 

559 

0180 

A4 

1F 

560 

018F 

26 

04 

561 

562 

0191 

1C 

20 

563 

0193 

20 

02 

564 

565 

0195 

1D 

20 

566 

567 

568 

0197 

B6 

10 

569 

0199 

2B 

19 

570 

571 

572 

019B 

26 

10 

573 

0190 

B6 

11 

574 

019F 

26 

OC 

575 

576 

01A1 

15 

20 

577 

578 

01A3 

AE 

12 

579 

01A5 

7F 

580 

01A6 

5C 

581 

01A7 

A3 

19 

582 

01A9 

23 

FA 

583 

01AB 

20 

4C 

584 

585 

01A0 

AD 

5E 

586 

01AF 

CD 

02  32 

587 

01B2 

20 

45 

588 

589 

01 B4 

CD 

02  7A 

LDA 

HYSTCT 

BEQ 

Mr 

ecu 

SUB 

#1 

STA 

HYSTCT 

RTI 

•* 

HYSTCIC  LDA 

HYST 

CMP 

HYSTCT 

BEQ 

CU 

INC 

HYSTCT 

RTI 

****»**»»•»#»***« 


ELSE,  SEE  IF  WE  DECREMENT  THIS  TIME. 

IF  HYSTCT=0,  GO  TO  THE  COUNT  DOWN 

ROUTINE. 

ELSE,  DECREMENT  THE  HYSTERESIS  COUNTER, 

AND  WAIT  FOR  THE  NEXT  INTERRUPT. 

IF  ROTATING  CU 

AND  HYST  •  HYSTCT  

COUNT  THE  PULSE  . 

ELSE,  INCREMENT  THE  HYSTERESIS  COUNTER, 

AND  WAIT  FOR  ANOTHER  PULSE. 


CLOCKWISE  ROUTINE. 


cw 


EOU 


INCREMENT  THE  BINARY  COUNTER  (BINCT). 


***************** 


LDA 

LOBIN   BEG 

ADD 

#1      LOB 

STA 

LOBIN 

*** 

LDA 

HIBIN 

ADC 

#0 

STA 

HIBIN 

*** 

*** 

******************  CLR/SET 

*** 

LDA 

LOBIN 

AND 

#X00011111 

BNE 

NOT_32 

**• 

BSET 

MOD_32,STAT 

BRA 

DIRCHK 

*** 

NOT_32 

BCLR 

MOD_32,STAT 

***~ 

*** 

DIRCHK 

LDA 

HIBIN 

BMI 

CWNEG 

*** 

*•• 

BNE 

CWPOS 

LDA 

LOBIN 

BNE 

CWPOS 

BEGIN  AT  THE  LSB  OF  THE  BINARY  COUNTER. 
LOBIN  +  1  ;  CARRY  ->  C,CCR 


ADD  THE  CARRY  TO  THE  HIGH  BYTE. 


CLR/SET  MOO  32  APPROPRIATELY. 


IF  THE  LOW  FIVE  BITS  OF  'LOBIN'  ARE  NOT 

NOT  THEN  THE  NUMBER  ISN'T  A  MODULO  32  NUMBER. 


IF  HIBIN  <  0  ,  WE'RE  ROTATING  CU  TOWARD 
THE  ORIGIN. 

ELSE  IF  BINCT  .NE.  0  , 
WE'RE  ROTATING  CW 
AWAY  FROM  THE  ORIGIN. 


BCLR    NEGTIV.STAT   ELSE,  WE'VE  GONE  THROUGH  ORIGIN  IN  CW 
DIRECTION.  CLR  NEGATIVE  SIGN. 


LDX 

#PTR3 

CLRIT2 

CLR 
INCX 

,x 

CPX 

#THOUTH 

BLS 

CLRIT2 

BRA 

UPOUT 

•** 

CWPOS 

BSR 

ADDBCD 

JSR 

INCPOS 

BRA 

UPOUT 

**• 

CWNEG 

JSR 

SUBBCD 

--RESET  ALL  COUNTERS  AND  DEGRES  TO  ZERO. 


UPDATE  OUTPUT. 
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590 

01B7 

CO 

02  9A 

591 

01 BA 

20 

3D 

592 

593 

594 

595 

596 

597 

598 

01BC 

599 

600 

601 

602 

603 

01 BC 

B6 

11 

604 

01  BE 

A4 

1F 

605 

01C0 

26 

04 

606 

607 

01C2 

1C 

20 

608 

01C4 

20 

02 

609 

610 

01C6 

1D 

20 

611 

612 

613 

614 

615 

01 C8 

B6 

11 

616 

01CA 

AO 

01 

617 

01CC 

B7 

11 

618 

619 

01CE 

B6 

10 

620 

01D0 

A2 

00 

621 

01D2 

B7 

10 

622 

623 

01D4 

B6 

10 

624 

01D6 

2A 

1B 

625 

626 

01D8 

A1 

FF 

627 

01DA 

26 

10 

628 

01DC 

B6 

11 

629 

01DE 

A1 

FF 

630 

01E0 

26 

OA 

631 

01E2 

14 

20 

632 

633 

634 

01E4 

AE 

12 

635 

01E6 

7F 

636 

01E7 

5C 

637 

01E8 

A3 

19 

638 

01 EA 

23 

FA 

639 

640 

01EC 

AD 

1F 

641 

01EE 

CO 

02  32 

642 

01F1 

20 

06 

643 

644 

01 F3 

CD 

02  7A 

645 

01F6 

CD 

02  9A 

646 

647 

648 

649 

650 

651 

652 

653 

654 

655 

01 F9 

JSR 
BRA 


DECPOS 
UPOUT 


ecu 


EQU 


*************************** ******************* 


COUNTER-CLOCKWISE  ROUTINE. 


CLR/SET  MOD  32  APPROPRIATELY. 


LDA 

AND 
BNE 

BSET 
BRA 


NO_32 

*** 

**• 


*** 
••• 

CLREH 


LDA 
SBC 
STA 

LDA 
BPL 

CMP 
BNE 
LDA 
CMP 
BNE 
BSET 


LDX 

CLR 

INCX 

CPX 

BLS 


CCWNEG  BSR 
JSR 
BRA 


*»* 

CCWPOS 

*** 

*** 
•* 


JSR 
JSR 


LOBIN 

#100011111 
MO_32 

MOO  32, STAT 

dec! in 


IF  THE  LOU  FIVE  BITS  OF  'LOBIN'  ARE  NOT 

ZERO  THEN  THE  NUMBER  ISN'T  A  MODULO  32  NUMBER. 


BCLR    MOO_32,STAT 


DECBIN  LDA 
SUB 
STA 


DECREMENT  THE  BINARY  COUNTER  (BINCT). 


LOBIN 

#1 

LOBIN 

HIBIN 

#0 

HIBIN 

HIBIN 
CCWPOS 


BEGIN  AT  THE  LSB  OF  THE  BINARY  COUNTER. 
LOBIN  =  LOBIN  -  1  ;  BORROW  ->  C,CCR 


SUBTRACT  THE  CARRY  FROM  THE  HIGH  BYTE. 


IF  HIBIN  .GE.  0  ,  WE'RE  ROTATING  CCU  TOWARD 
THE  ORIGIN. 


#-1 

CCWNEG 

LOBIN 

#-1 

CCWNEG  -- 

NEGTIV.STAT 


#PTR3 
,X 

#THOUTH 
CLREM 

ADDBCD 

INCPOS 
UPOUT 

SUBBCD 
DECPOS 


ELSE  IF  BINCT  .NE.  -1  , 
-WE'RE  ROTATING  CCW  AWAY 
FROM  THE  ORIGIN. 

ELSE,  WE'VE  GONE  THROUGH  ORIGIN  IN  CCU 

DIRECTION.   SET  NEGATIVE  SIGN. 

AND  SET  ALL  COUNTERS  APPROPRIATELY. 


RESET  ALL  COUNTERS  AND  DEGRES  TO  ZERO. 


** 

**  OUTPUT  ROUTINE.  ROUTINE  TO  PRINT  DATA  TO  THE  OUTPUT  PORTS.   BY 
**       CALLING  THE  APPROPRIATE  SUBROUTINE .( 'OUTCT'  TO  OUTPUT  THE 

**       THE  COUNT  AND  'OUTPOS'  TO  OUTPUT  THE  POSITION). 

** 


UPOUT  EQU 
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656 

657 

01 F9 

04 

20  04 

658 

01 FC 

1C 

01 

659 

01 FE 

20 

02 

660 

661 

0200 

1D 

01 

662 

663 

0202 

09 

20  04 

664 

665 

0205 

CO 

02  E5 

666 

0208 

80 

667 

668 

0209 

CO 

02  D8 

669 

020C 

80 

670 

671 

672 

673 

674 

0200 

B6 

16 

675 

020F 

AB 

01 

676 

0211 

A1 

63 

677 

0213 

23 

05 

678 

0215 

AO 

64 

679 

0217 

99 

680 

0218 

20 

01 

681 

682 

021A 

98 

683 

021B 

B7 

16 

684 

021D 

97 

685 

686 

021 E 

D6 

03  28 

687 

0221 

B7 

1B 

688 

0223 

24 

OC 

689 

690 

691 

0225 

B6 

15 

692 

0227 

A9 

00 

693 

0229 

B7 

15 

694 

022B 

97 

695 

696 

022C 

D6 

03  28 

697 

022F 

B7 

1A 

698 

699 

0231 

81 

700 

701 

702 

703 

704 

705 

706 

707 

0232 

00 

20  04 

708 

709 

0235 

A6 

08 

710 

0237 

20 

02 

711 

712 

0239 

A6 

07 

713 

023B 

B7 

1D 

714 

715 

716 

717 

718 

0230 

B6 

14 

719 

023  F 

BB 

1D 

720 

0241 

A1 

09 

721 

0243 

23 

05 

BRSET  NEGTIV, STAT, MINUS  -- 

BSET  POSTIV.PORTB 

BRA  DISCHK 
**  --    SET  THE  NEGATIVE  SIGN 

MINUS   BCLR    POSTIV.PORTB       --      APPROPRIATELY. 

** 

DISCHK  BRCLR   POSCT.STAT.PUTCT 

** 

JSR     OUTPOS 
RTI 
** 

PUTCT   JSR     OUTCT 
RTI 

** 
************************************************************************ 

***********  SUBROUTINE  TO  INCREMENT  THE  BCD  COUNTER  (BCDCT).  ********* 

*** 

ADDBCO  LDA  CTPTR1 

ADO  #1 

CMP  #99     CTPTR  >  99  ? 

BLS  OK1     NO,  WE'RE  OK  HERE.  LOOK  UP  THE  FIRST  TWO  DIGITS. 

SUB  #100    YES...  MOOIFY  THE  CTPTR, 

SEC  SET  THE  CARRY,  AND 

BRA  OK1A    USE  TABLE  LOOK  UP. 
*** 

OK1     CLC  NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT. 

OK1A    STA     CTPTR1   -- 

TAX 
***  --  LOOK  UP  THE  TWO  LEAST  SIGNIFICANT  DIGITS. 

LDA     TABLE, X   -- 

STA     TENONE   -- 

BCC     NOMO  AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

*** 
*** 

LDA  CTPTR2 

ADC  #0      ADD  THE  CARRY. 

STA  CTPTR2  -- 

TAX 

***  --  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

LDA  TABLE, X 

STA     HUNDRD   -- 
*** 

NOMO    RTS 
*** 

************************************************************************ 

*******  SUBROUTINE  TO  INCREMENT  THE  POSITION  COUNTER  (DEGRES).   ******* 

*** 

****  FIRST  CHECK  TO  SEE  IF  THE  BINARY  COUNTER  HAS  REACHED  A  MODULO  32 

****     NUMBER. 

**** 

INCPOS  BRCLR   MCO_32,STAT, INC7   'MCO_32,STAT'  SET  ? 

**** 

LDA     #8  YES  ... 

BRA     INC  INCREMENT  THE  POSITION  BY  0.008  DEGREES. 

**** 

INC7    LDA     #7  NO  

INC     STA     POSINC        INCREMENT  THE  POSITION  BY  0.007  DEGREES. 

**** 

****  ROUTINE  TO  INCREMENT  THE  POSITION  COUNTER  , 'DEGREES' , BY  A 

****     PREDETERMINED  AMOUNT,  'POSINC. 

***• 

LDA  PTR1 

ADD  POSINC 

CMP  #9      PTR1  >  9  ? 

BLS  OK3     NO,  WE'RE  OK  HERE.   LOOK  UP  THE  FIRST  DIGIT. 
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722 

0245 

A0 

OA 

723 

0247 

99 

724 

0248 

20 

01 

725 

726 

024A 

98 

727 

024B 

B7 

14 

728 

024D 

97 

729 

730 

024E 

D6 

03  28 

731 

0251 

B7 

19 

732 

0253 

24 

24 

733 

734 

735 

0255 

B6 

13 

736 

0257 

A9 

00 

737 

0259 

A1 

63 

738 

025B 

23 

05 

739 

025D 

AO 

64 

740 

025  F 

99 

741 

0260 

20 

01 

742 

743 

0262 

98 

744 

0263 

B7 

13 

745 

0265 

97 

746 

747 

0266 

D6 

03  28 

748 

0269 

B7 

18 

749 

0266 

24 

OC 

750 

751 

752 

0260 

B6 

12 

753 

026F 

A9 

00 

754 

0271 

B7 

12 

755 

0273 

97 

756 

757 

0274 

D6 

03  28 

758 

0277 

B7 

17 

759 

760 

0279 

81 

761 

762 

763 

764 

765 

766 

027A 

B6 

16 

767 

027C 

AO 

01 

768 

027E 

24 

03 

769 

0280 

AB 

64 

770 

0282 

99 

771 

772 

0283 

B7 

16 

773 

0285 

97 

774 

775 

0286 

D6 

03  28 

776 

0289 

B7 

1B 

777 

028B 

24 

OC 

778 

779 

780 

0280 

B6 

15 

781 

028F 

A2 

00 

782 

0291 

B7 

15 

783 

0293 

97 

784 

785 

0294 

06 

03  28 

786 

0297 

B7 

1A 

787 

SUB 

#10 

YES...  MODIFY  THE  CTPTR, 

SEC 

SET  THE  CARRY,  AND 

BRA 

0K3A 

USE  TABLE  LOOK  UP. 

MM 

ota 

CLC 

NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT 

0K3A 

STA 

PTR1 

-- 

TAX 

-- 

#*** 

--  LOOK  UP  THE  LEAST  SIGNIFICANT  DIGIT. 

LOA 

TABLE, X 

-- 

STA 

THOUTH 

-- 

BCC 

DONE 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

MM 

MM 

LDA 

PTR2 

ADC 

fO 

ADD  THE  CARRY. 

CMP 

#99 

PTR2  >  99  7 

BLS 

0K4 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

SUB 

#100 

YES... MODI  FY  THE  CTPTR, 

SEC 

SET  THE  CARRY, 

BRA 

0K4A 

AND  USE  TABLE  LOOK  UP. 

MM 

0K4 

CLC 

NO  CARRY  EXISTS  IF  WE  ENTER  AT  THIS  POINT 

0K4A 

STA 

PTR2 

-- 

TAX 

-- 

MM 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE 

LDA 

TABLE, X 

-- 

STA 

HUNDTH 

-- 

BCC 

DONE 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

•••* 

MM 

LDA 

PTR3 

ADC 

#0 

ADD  THE  CARRY. 

STA 

PTR3 

-- 

TAX 

-- 

**** 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

LDA 

TABLE, X 

-- 

STA 

ONEDEG 

-- 

**** 

DONE 

RTS 

**# 

** 

a*********************************************************************** 

»** 

SUBBCD  LDA     CTPTR1 

SUB     #1      CTPTR  >  99  ? 

BCC     OK6     NO,  WE'RE  OK  HERE.  LOOK  UP  THE  FIRST  TWO  DIGITS. 
#100    YES,  MODIFY  THE  CTPTR,  AND 
GENERATE  A  BORROW. 


--  LOOK  UP  THE  TWO  LEAST  SIGNIFICANT  DIGITS. 


ADD 

#100 

SEC 

M* 

OK6 

STA 
TAX 

CTPTR1 

M* 

LDA 

TABLE, X 

STA 

TENONE 

BCC 


COMPLT 


LDA 

CTPTR2 

SBC 

#0 

STA 

CTPTR2 

TAX 

LDA 

TABLE, X 

STA 

HUNDRD 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  BORROW. 


SUBTRACT  THE  CARRY.  CTPTR  >  99  ? 


-  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 
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788 

0299 

81 

COMPLT 

RTS 

789 

*** 

790 
791 

1  SUBROUTINE  TO 

»#*#**#**#*#####*##*###*##*###**#*#*#**#********* 

792 

*** 

793 

****  FIRST  CHECK              UNARY  COUNTER  HAS  REACHED  A  MODULO 

794 

••** 

NUMBER 

. 

795 

**** 

796 

029A 

00 

20  04 

DECPOS 

BRCLR 

MOD_32. 

STAT.DEC7        ' MOD_32 , STAT '  SET  ? 

797 

MHH 

798 

029D 

A6 

08 

LDA 

#8 

YES... 

799 

029F 

20 

02 

BRA 

DEC 

DECREMENT  THE  POSITION  BY  0.008  DEGREES. 

800 

HH 

801 

02A1 

A6 

07 

DEC7 

LDA 

#7 

NO  .... 

802 

02A3 

B7 

1D 

DEC 

STA 

POSINC 

DECREMENT  THE  POSITION  BY  0.007  DEGREES. 

803 

MM 

804 

****  ROUT  IN 

DECREMENT  THE  POSITION  COUNTER  , 'DEGREES' , BY  A 

805 

**»* 

PREDETERMINED 

AMOUNT,  'POSINC. 

806 

MM 

807 

02A5 

B6 

14 

LDA 

PTR1 

808 

02A7 

BO 

10 

SUB 

POSINC 

PTR1  <  0  ? 

809 

02A9 

24 

03 

BCC 

OK8 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  FIRST  DIGIT. 

810 

02AB 

AB 

OA 

ADD 

#10 

YES,  MODIFY  THE  CTPTR,  AND 

811 

02A0 

99 

SEC 

GENERATE  A  BORROW. 

812 

**** 

813 

02AE 

B7 

14 

0K8 

STA 

PTR1 

-- 

814 

02B0 

97 

TAX 

-- 

815 

**** 

--  LOOK  UP  THE  LEAST  SIGNIFICANT  DIGIT. 

816 

02B1 

06 

03  28 

LDA 

TABLE, X 

-- 

817 

02B4 

B7 

19 

STA 

THOUTH 

-- 

818 

02B6 

24 

1F 

BCC 

DUNSUB 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  BORROW. 

819 

*** 

820 

*** 

821 

02B8 

B6 

13 

LDA 

PTR2 

822 

02BA 

A2 

00 

SBC 

#0 

SUBTRACT  THE  BORROW.   PTR2  <  0  ? 

823 

02BC 

24 

03 

BCC 

OK9 

NO,  WE'RE  OK  HERE.  LOOK  UP  THE  NEXT  TWO  DIGITS. 

824 

02BE 

AB 

64 

ADD 

#100 

YES,  MODIFY  THE  CTPTR,  AND 

825 

02C0 

99 

SEC 

GENERATE  A  BORROW. 

826 

*** 

827 

02C1 

B7 

13 

0K9 

STA 

PTR2 

-- 

828 

02C3 

97 

TAX 

-- 

829 

*** 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE. 

830 

02C4 

D6 

03  28 

LDA 

TABLE, X 

-- 

831 

02C7 

B7 

18 

STA 

HUNDTH 

-- 

832 

02C9 

24 

OC 

BCC 

DUNSUB 

AND  CONTINUE  ONLY  IF  THERE  WAS  A  CARRY. 

833 

*** 

834 

*** 

835 

02CB 

B6 

12 

LDA 

PTR3 

836 

02CD 

A2 

00 

SBC 

#0 

SUBTRACT  THE  BORROW. 

837 

02CF 

B7 

12 

STA 

PTR3 

-- 

838 

02D1 

97 

TAX 

-- 

839 

**** 

--  LOOK  UP  THE  NEXT  TWO  DIGITS  IN  THE  TABLE 

840 

02D2 

D6 

03  28 

LDA 

TABLE, X 

-- 

841 

0205 

B7 

17 

STA 

ONEDEG 

-- 

842 

**** 

843 

0207 

81 

DUNSUB 

RTS 

844 

*** 

845 

** 

846 

M 

847 

************************************************************************ 

848 

*• 

849 

**  OUTPUT  COUNT 

(OUTCT) 

.   SUBROUTINE  TO  MOVE  THE  CURRENT  COUNT  (BCDCT) 

850 

•* 

TO  THE 

OUTPUT 

PORTS.   REMOVES  THE  DECIMAL  POINT  FROM  THE 

851 

** 

DISPLAY  AND  BLANKS  ALL  BUT  THE  LEAST  SIGNIFICANT  DIGIT.  ALSO 

852 

** 

SETS  THE  MINUS 

SIGN  IF  APPROPRIATE. 

853 

** 
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854 

02D8 

855 

856 

0208 

B6  1B 

857 

02DA 

B7  02 

858 

859 

020C 

B6  1A 

860 

02DE 

B7  00 

861 

862 

02E0 

1E  01 

863 

02E2 

19  01 

864 

865 

02E4 

81 

866 

867 

868 

869 

870 

871 

872 

873 

02E5 

874 

875 

02E5 

B6  19 

876 

02E7 

A1  05 

877 

02E9 

25  2D 

878 

02EB 

B6  18 

879 

02ED 

A4  09 

880 

02EF 

A1  09 

881 

02F1 

26  1D 

882 

02F3 

B6  18 

883 

02F5 

A1  99 

884 

02F7 

27  04 

885 

02F9 

AB  07 

886 

02FB 

20  1D 

887 

888 

889 

02  FD 

A6  00 

890 

02FF 

B7  02 

891 

0301 

99 

892 

893 

0302 

B6  17 

894 

0304 

A4  09 

895 

0306 

A1  09 

896 

0308 

26  13 

897 

030A 

B6  17 

898 

030C 

AB  07 

899 

030E 

20  11 

900 

0310 

B6  18 

901 

0312 

AB  01 

902 

903 

0314 

B7  02 

904 

0316 

20  05 

905 

906 

0318 

B6  18 

907 

031A 

B7  02 

908 

031 C 

98 

909 

910 

031D 

B6  17 

911 

031 F 

A9  00 

912 

0321 

B7  00 

913 

914 

0323 

18  01 

915 

0325 

1F  01 

916 

917 

0327 

81 

918 

919 

TENONE 
PORTC 

HUMDRD 
PORTA 

DECPT, PORTB 
BLANK, PORTB 


OUTCT   EOU 

** 

LDA 

STA 

** 

LDA 
STA 

BSET 

BCLR 

** 

RTS 

** 
************* 


•*  OUTPUT  POSITION  (OUTPOS).   SUBROUTINE  TO  MOVE  THE  CURRENT  POSITION 
*•       COUNT  (BCOCT)  TO  THE  OUTPUT  PORTS.  THE  DECIMAL  POINT  IS 

**       DISPLAYED  ,  AND  ONLY  THE  MOST  SIGNIFICANT  DIGIT  IS  BLANKED. 

** 

OUTPOS  EQU     $ 


IF  5  >  'THOUTH'  SIMPLY  TRUNCATE  THE 
DISPLAY.  OTHERWISE... 
IF  THE  LAST  DIGIT  ISN'T  A  NINE  IT  IS 
EASY  TO  ROUND  UP.   JUST  ADD  A  ONE. 

BUT  IF  THE  LAST  DIGIT  IS  A  NINE  CHECK  TO 
SEE  IF  IT'S  99.   IF  SO  IT  GETS  GRIM. 

IF  THE  NUMBER  IS  X9  AND  X  .NE.  9,  THEN 
JUST  ADD  SEVEN  TO  ROUND  UP.  DUE  TO 
HEX  I DECIMAL. 
IF  THE  LOU  TWO  DIGITS  ARE  BOTH  NINES 

AND  WE  NEED  TO  ROUND  UP 

MAKE  THE  LOU  TWO  DIGITS  BOTH  ZEROS 
AND  SET  THE  CARRY. 

CHECK  THE  LAST  DIGIT  AS  BEFORE. 

IF  USING  THIS  PORTION  OF  THE  CODE 

THERE  HAD  TO  BE  A  CARRY. 

IF  THE  LAST  DIGIT  IS  A  NINE  DO  THE 

CARRY  HERE.   IF  NOT  USE  THE  ADC 

INSTRUCTION  TO  TAKE  CARE  OF  IT 

BELOW. 


THIS  IS  ALL  THAT  NEEDS  TO  BE  DONE  IF 
THE  LAST  DIGIT  IS  NOT  A  NINE. 


AND  IF  THERE  IS  NO  CARRY  IT'S  EVEN  EASIER. 


LDA 

THOUTH  -- 

CMP 

#5 

BLO 

TRUNC 

LDA 

HUNDTH 

AND 

#9 

CMP 

#9 

BNE 

DECIMAL 

LDA 

HUNDTH 

CMP 

#$99 

BEO 

UGLY 

ADD 

#7 

BRA 

PCOUT 

** 

** 

UGLY 

LDA 

#00 

STA 

PORTC 

SEC 

-- 

** 

LDA 

ONEDEG  -- 

AND 

#9 

CMP 

#9 

BNE 

NEXT 

LDA 

ONEDEG 

ADD 

#7 

BRA 

PAOUT 

DECIMAL 

LDA 

HUNDTH  -- 

ADD 

#1 

** 

STA 

PORTC 

BRA 

NEXT 

»» 

TRUNC 

LDA 

HUNDTH   -- 

PCOUT 

STA 

PORTC 

CLC 

-- 

»* 

NEXT 

LDA 

ONEDEG 

ADC 

#0 

PAOUT 

STA 

PORTA 

*• 

BSET 

BLANK, PORTB 

BCLR 

DECPT.PORTB 

RTS 
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920 

** 

921 

**  SET 

UP  THE 

TABLE  TO  BE  USED  WITH  BCD  INCREMENT/DECREMENT  ROUTINES. 

922 

** 

923 

• 

ENDS 

924 

* 

DATA 

925 

0328 

00 

01 

02 

03 

04 

TABLE 

FCB 

$00, $01, $02. $03, $04, $05, $06, $07, $08. $09 

0320 

05 

06 

07 

08 

09 

926 

0332 

10 

11 

12 

13 

14 

FCB 

$10,$11,$12,$13,$14,$15,$16,$17,$18,$19 

0337 

15 

16 

17 

18 

19 

927 

033C 

20 

21 

22 

23 

24 

FCB 

$20, $21 ,$22,$23,$24,$25,$26,$27,$28,$29 

0341 

25 

26  27  28  29 

928 

0346 

30  31 

32 

33 

34 

FCB 

$30,$31,$32,$33,$34,$35,$36,$37,$38,$39 

034B 

35 

36  37  38  39 

929 

0350 

40 

41 

42  43  44 

FCB 

$40, $41 ,$42, $43, $44, $45, $46, $47, $48, $49 

0355 

45 

46  47  48  49 

930 

035A 

50 

51 

52 

53 

54 

FCB 

$50,$51,$52,$53,$54,$55,$56,$57,$58,$59 

035  F 

55 

56 

57 

58 

59 

931 

0364 

60 

61 

62 

63 

64 

FCB 

$60 , $61 , $62 , $63 , $64 , $65 , $66 , $67, $68 , $69 

0369 

65  66  67  68  69 

932 

036E 

70 

71 

72 

73 

74 

FCB 

$70,$71,$72,$73,$74,$75,$76,$77,$78,$79 

0373 

75 

76  77  78 

79 

933 

0378 

80 

81 

82 

83 

84 

FCB 

$80,$81,$82,$83,$84,$85,$86,$87,$88,$89 

0370 

85 

86 

87  88 

89 

934 

0382 

90 

91 

92 

93 

94 

FCB 

$90 , $91 , $92 , $93 , $94 , $95 , $96, $97, $98 , $99 

0387 

95 

96 

97  98 

99 

935 

* 

ENDS 

936 

• 

CODE 

937 

************************************************************************ 

938 

** 

939 

** 

SET  UP  MASK  OPTION  REGISTER. 

940 

*• 

941 

038C 

ABSOLUTE        JUST  TO  ENSURE  THAT  THE  INTERRUPT  VECTORS 

942 

** 

ARE  CORECTLY  LOCATED. 

943 

** 

944 

** 

945 

0F38 

ORG 

MOR 

946 

0F38 

07 

FCB 

#BIT2*BIT1+BIT0 

947 

** 

948 

** 

COMMENTS: 

949 

** 

BIT  7 

CLOCK  SOURCE  0  =  CRYSTAL. 

950 

** 

BIT  6 

TIMER  OPTION  0  =  INTERNAL. 

951 

** 

BIT  5 

TIMER/CLOCK  SOURCE  0  =  INTERNAL. 

952 

** 

BIT  4 

NOT  USED. 

953 

** 

BIT  3 

NOT  USED. 

954 

** 

BIT  2 

SET   - 

955 

** 

BIT  1 

SET    -  PRESCALE  SELECT   111  =>  128 

956 

** 

BIT  0 

SET   - 

957 

** 

958 

** 

959 

************************************************************************ 

960 

** 

961 

** 

ASSIGN  INTERRUPT  VECTORS. 

962 

•* 

963 

0FF8 

ORG 

INTRPT 

964 

** 

965 

0FF8 

0139 

FDB 

BLINK   TIMER/INT2  INTERRUPT  VECTOR. 

966 

OFFA 

0158 

FDB 

COUNT   EXTERNAL  INTERRUPT  VECTOR. 

967 

OFFC 

0158 

FDB 

COUNT   SOFTWARE  INTERRUPT  VECTOR,  NOT  USED. 

968 

OFFE 

0080 

FDB 

RESTRT  RESET  VECTOR. 

969 

** 

970 

** 

971 

*• 

972 

ENDS 

973 

1000 

END 

Lines  Assembled 

:  973 

Assembly  Errors  :  0 
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